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THE N-BOD2 USER’S AND PROGRAMMER S MANUAL 


Harold P. Frisch 

Goddard Space Flight Center 
Greenbelt, Maryland 


INTRODUCTION 

The general purpose digital program N-BOD, and its present version N-BOD2, have been de- 
veloped with the needs of the spacecraft attitude dynamicist foremost in mind. This fact, 
however, does not detract in any way from its applicability to a much broader class of 
problems. The program may be used to both derive and output in a vector-dyadic form, 
and/or to solve numerically the equations of motion of any system that may be adequately 
- modeled, for the purposes of dynamic simulation, as a topological tree of point-connected 
rigid bodies, flexible bodies, point masses, and symmetrical momentum wheels (commonly ' 
called “symmetric wheel” in this document). 

The underlying theoretical development upon which the program N-BOD2 is based may be 
found in References 1 and 2. In the FORTRAN IV- coding of this program, a definite 
attempt has been made to draw a balance between available generality, ease. of user opera- 
tion, and computational speed and efficiency. . ' 

The program is structured to expand or contract with the required needs of the user. By 
an internal interrogation of the input data, the program sets up a series of logic flags that 
determine the computational options that should be used and those that should not. 

In most practical problems, the user will be required to interface with the program. The out- 
put routine, which is called every integration step, prints virtually all system state variables 
along with numerous other physically meaningful parameters that are useful for initial check- 
out purposes. In setting up the output routine for production runs, the user is expected to 
literally delete the unwanted print statements from the output subroutine and insert his 
own. 

If external forces and torques act on the system or if nongyroscopic forces and torques act 
internal to the system at hinge points, the user is required to define them. This will present 
no particular problem since a number of examples are provided which show exactly how most 
commonly occurring forces and torques are defined and coded. 



Frequently programs already exist that define, for example, the workings of a complex 
attitude control system. State-variable information is required as input to it and motor 
torques are outputted from it. By a few simple interface statements, which create the proper 
state-variable parameters for the existing torque routine and the required force and torque 
parameters for N-BOD2, the debugged routine may be inserted in total into N-BOD2. 

The input of data is provided for in three separate subroutines which are called sequentially. 
The first is of a rigid format. In this routine a basic coupled rigid body, point mass, and 
symmetric wheel model of the system -is described. Connection topology, degrees of freedom, 
mass, inertia, and geometric parameters, along with relative body orientation and initial 
kinematic conditions, are inputted here. The second input routine is more flexible. Num- 
erous options are available and may be called for by use of option cards. For example, 
some of the bodies may be redefined to be flexible ; if so, the flexible body data would be 
inputted at this point. The third input routine is for the user. Any data that will be required 
for the torque and output routines, written by the user, are entered here. It may be left empty, 
or again the user may insert an existing input routine and set up the proper interface state- 
ments. It is permissible, and at times is convenient, for the user to use this routine to over- 
ride some data already inputted in the first input routine. 

When the analyst is first presented with a particular problem for dynamic simulation, he is 
usually provided with just enough information to create a topological model, define the 
character of each body in the model (rigid body, flexible body, point mass, or symmetric, 
wheel), and to define the number of degrees of relative freedom between contiguous bodies. 
With this information and a fictitious set of mass and inertia properties, the user may obtain 
the equations of motion for the simulation model. At times, this is the end product. 

With the outputted equations of motion, the user will immediately recognize familiar terms 
and will need only a cursory glance at the rather lengthy symbol list for exact definitions. 

There is a one-for-one correspondence between the outputted equations and those provided 
in References 1 and 2. For example, the outputted statements 

FOMC(S) X (XIC(5) • F0MC(5)) 

and 

FOMC(3) X (FOMC(3) X CAC(3)) • - ...» 

•translate to the familiar vector tensor expressions 

■ • - . -tv finH'V’tr ?tBdmig aril .aisdmjg 

x (*5 * "s> 
and 

'■ w 3 X (w 3 X a 3 ) 

respectively. 
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To use this program effectively, the user must become familiar with the array names used 
to define the various physical characteristics and state variables in the equations of motion. 

This is most easily done by a study of the computer derived equations of motion. Once this 
is done the user is in a position to proceed to code the required input, torque, and output 
routines for his particular problem and to make use of the full power of N-BOD2. 

THE SIMULATION MODEL 

The analysis of the dynamic characteristics of a complex system is usually done through the 
-study of a simulation model. The simulation model must possess the same dynamic charac- 
teristics as the complex system and at the same time be amenable to mathematical analysis. 

Rigid bodies, point masses, and symmetric wheels are idealized bodies that readily lend them- 

- ^ ’ 

selves to mathematical analysis. Flexible bodies are more complex; however, if the defor- 
mation is small and the laws of linear elasticity can be applied, the dynamic characteristics 
can be simulated by the natural modes and frequencies of vibration, the determination of 
which is a subject in itself, f N-BOD2 simply assumes that the modes and frequencies of flex- 
ible bodies are obtainable; it accepts only resultant mode-dependent parameters in the input 
data stream (see Appendix B). ] 

N-BOD2 assumes that the complex system under study may be simulated by a model com- 
prised of rigid bodies, point masses, symmetric wheels, and flexible bodies for which natural 
modes and frequencies of vibration are available. Contiguous rigid and flexible bodies are 
assumed to be point connected in such a manner that the total system forms a topological 
tree (no closed paths). Furthermore, point masses are assumed to exist only at limb ends 
while symmetric wheels are assumed to be imbedded within either rigid or flexible bodies. 

The present version of N-BOD2 has certain limitations with respect to the simulation of flex- 
ible bodies. The author has not coded the equations required to allow hinge points and 
wheel attachment points on flexible bodies to be time varying in the flexible body’s body- 
fixed reference frame. This will be done if future simulation demands require it. It should 
be noted that the equations exist and can be found in Reference 2, in a form amenable for 
inclusion into N-BOD2. 

The simulation model must reflect the fact that relative motion between contiguous bodies 
may be kinematically constrained. To do this, N-BOD2 assumes that contiguous rigid and 
flexible bodies are connected together by physically realizable 0-, 1-, 2-, or 3-degrees-of;freedom 
gimbals. The gimbals prohibit relative translational motion and permit, at most, 3 
degrees of relative rotational freedom at hinge points. Point masses may have 0, 1, 2, or 3. 
degrees of relative translational freedom and symmetric wheels may have 1 degree of rota- 
tional freedom relative to the body in which they are imbedded. Flexible bodies may pos- 
sess several degrees of vibrational freedom in addition to the degrees of freedom associated 
with the connection gimbals. Practical computer storage and speed limitations put a limit 
on the total number of vibrational modes allowed for the total system of coupled bodies. 



PROGRAM OVERVIEW, MAIN PROGRAM, AND SUBROUTINE DYN 

The basic flow logic of the program N-BOD2 is shown on the flowchart in figures 1 and 2 
using the symbology listed below. Immediately upon entry into, the MAIN program a single 
control card is read. The data on this card sets several logic flags that control the mode of 
data input and output. 



Flow Chart Symbology 

Conditional Statement 
Call Subroutine 
Call to I/O Device 

Computation ' 

Program Point 

Primary Path for Program Flow 

Secondary Path for Program Flow 
(Usually option related or a once-only path 
for initial setup) 



The input data may either define the physical and .kinematic parameters for a new job that 
will start at time zero, or define the parameters needed to restart the program at the termi- 
nation time of a previous run. 

The output data may either be a listing of the system equations of motion or the output of 
selected system state variables. Upon reaching the termination time of a particular job, a 
restart tape may be requested. . This tape contains all data required to restart the job at a 
later date. 

If a restart run is to be made, the restart tape created at the end of a previous run becomes 
the input tape for the present run. It contains the magnitude of every computer-generated 
parameter required for a reinitiation of computation. The tape is read in and the. program 
then immediately branches to the start of the integration loop and proceeds as if the previous 
run had never been terminated. 

If a new run starting at time zero is to be made, three input subroutines are sequentially called 
The first called is INBS. In this subroutine, the basic system is defined. The data are checked 
in INEROR for physical realizability, and then subroutine SETS is entered. In SETS, various 
integer sets are computed that enable the program to avoid redundant and trivial computa- 
tion. Subroutine INOPT, the second input routine, is programmed to recognize various op- 
tion codes. The available options fall into two categories: those that expand modeling capa- 
bility, e.g., flexible body option, caged degree of freedom option; and those that attempt to 
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ENTER, START OF JOB 



Figure 1. Main program flowchart. 
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improve computational efficiency and run time by allowing the user to introduce engineer- 
ing judgment in deleting computations that he feels will have a negligible impact upon com- 
puted results. The last input routine is INTOR. Normally this routine is empty. It is 
inserted for the user. Any input data that the user requires for a description of the nongyro- 
scopic forces and torques acting on this system are entered here according to a user written 
code. The user’s input data should be stored in common block /SATELL/ which is reserved 
for the user. Normally, it contains an empty dummy array of 1000 real double precision 
words. . • 

With all necessary input data stored in computer memory, subroutine DYN is entered for the 
first time. The complete state of the system is computed at time zero and outputted. The 
primary integration loop is then entered. RUNGE is the integration package; it is a fixed- 
step, four-order Runge Kutta numerical integration routine that calls DYN to compute the 
equations of motion to be integrated. 

At the end of each integration loop, a check is made to determine if the output routine 
OUTPSP should be entered. At the termination time (a flag is reset in DYN), the program 
branches out of the integration loop, creates a restart tape if called for, and terminates if 
there is no succeeding run to follow. 

Subroutine DYN is used to call the subroutines in which the equations of motion are coded. 
Upon entry, a check is made to see if it is the first pass through; if so, certain initialization 
procedures must be carried out. Initial values for transformation matrices are obtained by 
TRNSIV; initial values for all vectors and dyads are obtained by VDIV; and initial values 
for all differential equations are defined in EQIV. If it is not the first pass through DYN, 
the call for DYN has been made by RUNGE. All of the system state variables obtained 
from RUNGE are sorted out in SETUP. TRAN computes all transformation matrices; 
TRANVD transforms all vectors and dyads to a common frame of computation; RATE 
computes all rate related vectors; XDY computes all inertia and pseudo inertia tensors on 
the left-hand side of the system equations of motion; and ETA computes all gyroscopic 
cross coupling torques found on the right-hand side of the equations. 

Subroutine TORQUE is user defined; all nongyroscopic forces and torques are defined here 
in vector form. To reduce the equations to a set of simultaneous scalar equations, QFDOT 
is called. Upon exit, a check is made in DYN to see if any degrees of freedom are caged. 
Appropriate action is taken by COMPRS i'fth'ey are caged, and the simultaneous equations 
are solved by SIMQ. All acceleration parameters are now at hand. DCT is then entered to 
get the derivatives of tire direction icosme'matr’ices, and ANGLE is entered to get the equa- 
tions that define relative displacement. All differential equations are then stacked in a one- 
dimensional array by SETUP in a form acceptable to RUNGE and return to RUNGE is made 
after a time check. . 
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PROGRAMMING TECHNIQUES USED 

A definite attempt has been made to reflect as much of the subscript notation as possible 
that is used in References 1 and 2 in the FORTRAN IV coding of the equations. Deviations 
from this practice occur at points where a more streamlined subscript notation leads to a 
considerable saving in computer storage and an increase in computational speed. It. should 
be realized that computation speed is severely compromised by. the unnecessary . use of multi- 
dimensioned arrays. ' . ' " 

N-BOD2 is built on the basis that the only labeling which should be done by the user is the 
labeling of bodies and wheels. All other required, labeling is done by the computer. The user, 
however, must be aware of the labeling rules that are used internally if he is to effectively 
interface with the program. -. 

Table 1 provides a listing of the symbol names used in the coding.of N-BOD2,their'dimen- 
sioii, type, storage location, and a very brief description of each along with the subroutine in 
which they are first defined and/or used extensively. A detailed definition of each symbolic 
name may be found in the comment cards of the subroutine and/or in the subroutine discus- 
sion included in this report. 

PROGRAMMER'S GUIDE TO MAIN PROGRAM AND SUBROUTINE DYN 

The purpose of the MAIN program and subroutine DYN is to sequentially call the primary , 
special purpose subroutines that read input data, define and integrate the'equations of motion, 
and write output data. A detailed discussion of the flow logic is provided in the section en- 
titled “Program Overview, MAIN Program* and Subroutine DYN.” 

The following variables defined in table 1 are either first introduced or used extensively in 
the MAIN program and subroutine DYN. 

CT4 — a counter. Used to count the number of passes through subroutine DYN, It is 

updated upon entry into DYN. The fourth order fixed step Runge Kutta integra-- 
tion routine calls DYN four times per integration step, consequently 

CT4 = 1 + 4 * (N - 1).+ J 

X ...during and after the . ith pass through DYN of ithe N th integration step. - *nwA 

CF4. = i 1 . , During and after the initialization pass through DYN-; ^ 

i.e., when called by MAIN 

FG1 — end of job flag. At the end of each integration step its status is checked in MAIN. 

If .TRUE., computation continues; if .FALSE., an end-of-run condition has been 
satisfied. If T.GE.TIMEND in DYN, FG1 is reset to .FALSE.. The user may define 
any other end-of-run condition he desires in subroutines TORQUE or OUTPSP. 
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Table 1 

Symbol Names Used in N-BOD2 


N-B0D2 IS DIMENSIONED TO ACCEPT A MAXIMUM OF 

N - BODIES (FLEXIBLE BODIES + RIGID BODIES ' + POINT MASSES) 

N - SYMMETRIC WHEELS 

2N - FLEXIBLE MODES OF VIBRATION (TOTAL FOR ALL FLEXIBLE BODIES) 
4N - MOOAL CROSS-COUPLING COEFFICIENTS (TOTAL) 

33 - INDEPENDENT DEGREES OF FREEDOM' 

160 FIRST ORDER NON-LINEAR DIFFERENTIAL EQUATIONS 

THIS VERSION OF N-B0D2 USES 
N = 10 

MAKING'USE OF N.LT.10 SAVES CONSIDERABLE COMPUTER STORAGE 

N.GT.10 RUN TIME FOR PRATICAL APPLICATION EXCESSIVE 


SYMBOL LIST ABBREVIATIONS 
IDFM2 = N**2 + N + 1 - (N*(N-l))/2 
IDEM3 = <N-1)**2 + N - ( ( N- 1 ) * ( N-2 > ) / 2 
1 DEM4 = SIZE OF /LOGIC/ 16 , LOGICAL WORDS 

IDEM5 = SIZE OF / I NTG/ 724 ‘ INTEGER WORDS 

IDEM6 = SIZE OF / INTGZ/ 70 INTEGER WORDS 

IDEM7 = SIZE OF /REAL/ 435V REAL WORDS 

IDEM8 = SIZE OF /REAL Z/ 168 REAL WORDS 

IDEM9 = SIZE OF /SATE LL / ft . 1000 REAL WORDS 

ALL COMPUTED VECTORS AND' TENSORS IN COMPUTING FRAME COORDINATES 
NA = OPTION NOT AVAILABLE IN N-B002 

# = number of 

BFC = BODY FIXED COORDINATES 

CFC = COMPUTING FRAME FIXED COORDINATES (BODY 1 OR INERTIAL) 

IFC = I NERT I ALL Y FIXED COORDINATES 
EOIV(XMN) = EQUIVALENCED TO XMN ARRAY 

0 : N = BY USE OF A DUMMY VARIABLE SUBSCR I PT 0 ALLOWABLE 

. . . . ' • /Ur- • . ' ■■ 

SYMBOL LIST AND STORAGE LOCATION 

NAME TYPE DIMENSION STORAGE DEFINITION AND SUBROUTINE USED IN 


ANGO R 3 ( N+ 1 ) EQIV(XMN) EULER ANGLE DOT ( ANGLE » SETUP ) 

AWORK • I -.200 i* /T NTG/‘- /•LOCAL WORK AREA TO SAVE STORAGE 

CA R 3,N /REAL/ CM VECTOR BFC (INBS) 

CAC R 3 *N /REAL/ CM VECTOR CFC t VO I V , TRANVD ) 

a y ..r! y . <• 
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Table 1 (Continued) 
Symbol Names Used in N-BOD2 


c 

CAO 

R 

3,N 

/REAL/ 

ZERO DEF CM VECT BFC (VDIV) 

c 

C8DUM ,CB 

R 

3,0:N 

/REALZ/ 

HINGE VECTOR BFC ( INBS) 

c 

CBCOUM,CBC 

R 

3t 0: N 

/REALZ/ 

HINGE VECTOR CFC (VDIV .TRANVD ) 

c 

CBN 

R 

3 

/REALZ/ 

HINGE VECTOR PART (INBS) 

c 

CLM 

R 

N 

/REAL/ 

SCALAR TORQUE ON WHEEL (TORQUE) 

c 

CNF 

R 

3,N 

E01 V ( XMN ) 

FORCE CENTRIPETAL + COR I OL I S ( ET A ) 

c 

COMC 

R 

3, N+l 

/REAL/ 

ANG RATE TO COMP FRAME ( RATE ,DCT ) 

c 

CT1 

I 


/INTG/ 

COUNTER (INOPT) UNUSED AFTER 

c 

CT 2 

I 


/ INTG/ 

COUNTER (INOPT) UNUSED AFTER 

c 

CT3 

I 


/INTG/ 

COUNTER (INOPT) UNUSED- AFTER 

c 

CTA 

I 


/INTG/ 

COUNTER ( INOPTJ+PASSES THRU (DYN) 

c 

C-T 5 

I 


/INTG/ 

COUNTER (INOPT) UNUSED AFTER 

c 

DOMC 

R 

3, N+l 

/REAL/ 

PART OF ANG. ACC. VEC. (RATE) 

c 

DUMMY 

R 

1000 

/SATELL/ 

STORAGE AREA FOR USER 

c 

ETC 

R 

3, N+l 

/REAL/ 

GYRO+EXT.TORQ.ON NEST (ETA.QFDOT) 

c 

ETIC 

R 

3 *N 

EOI V< XMN) 

INERT X-COUP TORO. (ETA) 

c 

ETM 

R 

33 

/REAL/ 

SCALAR, GENEAL I ZED TORQUES ( OF DOT ) 

c 

ETMC 

R 

3,N 

EOI V( XMN) 

WHEEL X-COUP TORO. (ETA) 

c 

FCF 

R 

3 , 3* AN 

/REAL/ 

MODAL CENTRIP X-COUP ( INOPT , QFDOT ) 

c 

FCK 

R 

3 , AN 

/REAL/ 

MODAL CORIOLIS X-COUP < I NOP T , OF DOT ) 

c 

FCON 

I 

3 (N+l > 

/INTG/ 

CODE, FREE VECTORS (INBS) 

c 

FG1 

L 


/LOGIC/ 

END OF RUN FLAG ( M A IN , D YN , OUTPSP ) 

c 

FG2 

L 


/LOGIC/ 

ERROR INPUT D AT A ( M A I N , I NE ROR ) 

c 

FG3 

L 


/LOGIC/ 

ERROR INPUT D AT A ( M A I N , I NOP T > 

c 

FGA 

L 


/LOGIC/ 

unOsed 

c 

FG5 

L 


/LOGIC/ 

OUTPUT DATA ? FLAG ( M A I N , TORQUE ) 

c 

FLA 

R 

3,2N 

/REAL/ 30 

MODAL CM VECTOR BFC (INOPT) 

c 

FLAC 

R 

3,2N 

/REAL/ 

MODAL CM VECTOR CFC ( VD IV , TRANVD ) 

c 

FLB 

R 

3,2N 

/REAL/ 

MODAL MOMENT VECTOR BFC (INOPT) 

c 

FLC 

R 

3 » 2N 

/REAL/ 

MODAL ROTATION MOMENT BFC (INOPT) 

c 

FLCRC 

R 

3 * N 

/REAL/ 

GYRO FLEXIBLITY FORCE (ETA) 

c 

FLD 

R 

3 » 3 » 2N 

/REAL/ 

MODAL INERTIA DYAD BFC (INOPT) 

c 

FLE 

R 

3,3,2N 

EOIV(FLD) 

FLD + FLD**T (VDIV) 

c 

FLH 

R 

3 * 3 » 2N 

EOIV(FLJ) 

FLD + FLH (VDIV) 

c 

FLIRC 

R 

3 * N 

/REAL/ 

GYRO FLEXIBLITY TORQUE (ETA) 

c 

FLJ 

R 

3 , 3 » 2N 

/REAL/ 

MODAL ROTATION DYAD BFC (INOPT) 

c 

FLO 

R 

3,2N 

EOIV(FLB) 

MODAL MOMENTUM VECTOR BFC (VDIV) 

c 

FLOC 

R 

3,2N 

/REAL/ 

FLO IN CFC ( VD I V i TRANVD ) 

c 

FLOM 

R 

2N 

/REAL/ 

MODAL FREQUENCY (INOPT) 

c 

FOMC 

R 

3, N+l 

/REAL/ 

INERTIAL RATE VECTOR (RATE) 

c 

GAM 

R 

3, IDEM2 

/REAL/ 

HINGE TO CM VECTOR (VD1V,XDY) 

c 

’h 

R 


/REAL/ 

INTEGRATION STEP SIZE ( RUNGE , INBS ) 

c 

HM 

R 

3* N 

/REAL/ 

WHEEL SPIN AXIS BFC ( INBS) 

c 

HMC 

R 

3 »N 

/REAL/ 

WHEEL SPIN AXIS CFC < VD I V , TRANVD ) 

c 

HMOM 

R 

N 

/REAL/ 

WHEEL ANGULAR MOMENTUM ( I NBS , SE TUP ) 


10 


<4UT3d 


Table 1 (Continued) 
Symbol Names Used' in N-BOD2 


c 

I DEMA 

I 


LOCAL 

SIZE OF /LOGIC/ (RSTA^RT) 

c 

I0EM5 

I 


LOCAL 

SIZE OF /INTG/ ( RST ART ) 

c 

IDEM6 

I 

- 

LOCAL 

SIZE OF / I NTGZ / ( RST ART ) 

c- 

IDEM7 

I 


LOCAL 

SIZE OF /REAL/ (RSTART) 

c 

IDEM8 

I 


' LOCAL 

SIZE OF /REALZ/ (RSTART) 

c 

IDEM9 

I 


LOCAL 

SIZE OF /SATELL/I RSTART) 

c 

I INIT 

I 

IDEM5 

EOI V ( AWORK ) Z ERO OUT / INTG/ ( RST ART ) . 

c- 

INERF 

L 


/LOGIC/ 

FL AG» BFC OR IFC FOR CFC ( INOPT ) 

c 

I Z IN IT 

I 

IDEM6 

EQIV ( SCNDUM ) ZERO OUT / I NTGZ / ( RST ART ) 

c 

JCON 

I 

N 

/INTG/ 

BODY CONNECTION MATRIX (INBS) 

c 

ICON - 

r 

2 ( N+ 1 ) 

/INTG/ 

CODEtLOCKED VECTORS (INBS) 

c 

L ANGLE’ • 

L 


• /LDEBUG/ 

PRINT EQUATIONS IN ANGLE? (MAIN) 

c 

LDCT 

L 


/LDEBUG/ 

PRINT EQUATIONS IN DCT? (.MAIN) 

c 

LEOU 

L 


EO I V ( ) 

EQIV IN EACH SUB TO PRINT FLAG 

c 

LEQUIV 

L 


/LDEBUG/ 

PRINT EQUATIONS IN EQIV? (MAIN) 

c 

LETA . 

L 


/LDEBUG/ 

PRINT EQUATIONS IN ETA? (MAIN) 

c 

LINIT 

L 

IDEMA 

EOIV(FGl) 

ZERO OUT /LOGIC/ (RSTART) 

c 

LQFDOT 

L 


/LDEBUG/ 

PRINT EQUATIONS IN QFDOT? (MAIN) 

c 

LRATE 

L 


/LDEBUG/ 

PRINT EQUATIONS IN RATE? (MAIN) 

c 

LRTAPE 

L 


/CHEKS/ 

CREATE RESTART TAPE?'(MAIN) 

c 

LRUNGE 

L 


/LDEBUG/ 

PRINT EQUATIONS IN RUNGE? (MAIN) 

c 

LSETUP 

L 


/LDEBUG/ 

PRINT EQUATIONS IN SETUP? (MAIN) 

C' 

LSIMO 

L 


/LDEBUG/ 

PRINT EQUATIONS IN SIMO?. (MAIN) 

c 

LTORQU 

L 


/LDEBUG/ 

PRINT EQUATIONS IN TORQUE? (MAIN) 

c 

LTRAN 

L 


- /LDEBUG/ 

PRINT EQUATIONS IN TRAN? (MAIN) 

c 

LTRANV 

L 


/LDEBUG/ 

PRINT EQUATIONS IN TRANVD? (MAIN) 

c 

LTRNSI 

L 


/LDEBUG/ 

PRINT EQUATIONS IN TRNSIV? (MAIN) 

c 

LVDIV 

L 


/LDEBUG/ 

PRINT EQUATIONS IN VDIV? (MAIN) 

c 

LXOY 

L 


/LDEBUG/ 

PRINT EQUATIONS IN XOY? (MAIN) 

c 

MO 

I 

N 

/INTG/ . 

BODY IN WHICH WHEEL IS IN (INBS) 

c 

NBOD 

I 


/INTG/ 

NUMBER OF BODIES ( INBS)' 

c 

NB1 . 

I 


/INTG/ 

NUMBER OF BODIES +1 (INBS) . 

c 

■ NCTC 

I 


/INTG/ 

( INOPT, NA) CONSTRAINT TORQUES 

c 

NEO 

I 


LOCAL , 

# EQUATIONS SETUP BY N-BOD2 (EQIV 

c 

NFER 

I 


/INTG/ 

# FREE COORD VECTORS (INBS) 

c 

NFKC 

I 


/INTG/ 

(INOPT, NA) CONSTRAINT FORCES . 

c 

NFIXB 

I 


/INTG/ 

# FLEXIBLE BODIES (INOPT) 

c 

NFRC 

I 


/INTG/ 

# RELATIVE ANGLES COMPUTED (INOPT 

c 

NLOR 

I 


/INTG/ 

# LOCKED COORD VECTORS) INBS ) 

c 

NMO . 

I 


/INTG/ 

TOTAL NUMBER OF WHEELS (INBS) 

c 

NMOA 

i 


/INTG/ 

# WHEELS TO COMP REL ANGLE (INOPT 

c 

NMODS 

i 


/INTG/ 

TOTAL # MODES FOd SYSTEM (INOPT) 

c 

NMV 

i 


->• -/INTG/ 

.# VARIABLE SPEED WHEELS •( INOPT ) 

c 

NST ART 

L 


/CHEKS/ 

NEW OR RESTART RUN?- (MAIN) 

c 

NS VP 

I 


/INTG/ . , 

H LOCKED VECTORS TRANSFORM ( VDIV ) 

►V.ant ) MUTM3MOM ■ fi 

C. K 

\ ija 

-7 >. 
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Table 1 (Continued) 
Symbol Names Used in N-BOD2 


c 

NSVO 

I 


/ 1 NTG/ 

# FREE VECTORS TRANSFORM (VDIV) 

c 

NTQ 

I 


/INTG/ 

# OIFF EOS. IN SUB TORQUE (TORQUE) 

c 

PCON 

I 

N+l 

/INTG/ 

# CONSTRAINED AXES AT HINGES(INBS) 

c 

PHI 

R 

3 ,N+ 1 

/REAL/ 

EXTERNAL TOROUE ON NEST (TORQUE) 

c 

PLM 

R 

N 

/REAL/ 

WHEEL SPIN INERTIA ( INBS) 

c 

OF 

R 

3,3(N+1) 

/REAL/ 

FREE VECTOR BFC ( INBS ) 

G 

OFC ' 

R 

3 * 3 ( N+ 1 ) 

/REAL/ 

FREE VECTOR CFC (VDIV* TRANVD ) • 

c 

QL 

R 

3 , 2 ( N + 1 ) 

/REAL/ 

LOCKED VECTOR BFC (INBS) 

c 

OLC 

R 

3,2<N+1) 

/REAL/ 

LOCKED VECTOR CFC ( VD I V , TRANVD )■ 

c 

RBLfl 

L 

N 

/LOGIC/ 

RIGID BODY OR POINT MASS? (INBS) 

c 

RINIT 

R 

IDEM7. 

EQIV(CA) 

ZERO OUT /REAL/ (RSTART) 

c 

ROMC 

R 

3, N + l 

/REAL/ 

RELATIVE RATE VECTOR (RATE) 

c 

RZINIT 

R 

’ IDEM8 

E.O I V ( CBDUM ) Z ERO OUT /REAL Z/ (RSTART) 

c 

SC 1 • ' 


3 ( N+ 1 ) 

/INTG/ ' 

FREE VECTORS CAGED ( I NO PT * UNC AGE ) 

c 

see 

I 

■ N 

/INTG/ 

UNUSED 

c 

SCG 

I 


/INTG/ 

# CAGED DEGREES ( INOPT , UNCAGE ) 

c 

SCNDUM, SCN 

I 

0: N-l 

/INTGZ/ 

CODE, CENTRI PETAL EFFECTS (INOPT) 

c 

SCRDIJM , SCR 


0 : N-l 

/INTGZ/ 

CODE, CORIOLIS EFFECTS (INOPT) 

c 

SCXC 

I 

2N 

EO I V ( TORO) 

CODE, X-COUP MODES ( I NOPT , OF DOT ) 

c 

SO 

I 


/INTG/ 

CODE, DIRECTION COSINES (INOPT) 

c 

seu 

I 


/INTG/ 

CODE, EULER ANGLES (INOPT) 

c 

SFCC 

I 


/INTG/ 

CODE, BODIES FLEX X-COUPLING (INOPT 

c 

SFKDUrt, SFK 

I 

0 : N-l 

/INTGZ/ 

CODE, CONSTRAINT FORC E ( INOPT , N A ) 

c 

SFLX 

I 


/INTG/ 

CODE, ALL FLEXIBLE BOD I E S ( I NOP T ) 

c 

SFR 

I 

3 ( N+ 1 ) 

/INTG/ 

CODE, COMPUTE FREE VEC ANGLE ( I NOPT ) 

c 

SFXM 

I 

N 

/INTG/ 

# MODES EACH BODY (INOPT) - 

c 

SG 

I 


/INTG/ 

CODE, ALL GYROSTATS(SETS) 

c 

SI 

I 

’ IDEM3 

/INTG/ 

JCODE, BODIES HINGE TO CM (SETS) 

c 

SIG. 

I 


/INTG/- 

UNUSED 

c 

S I XDUM » S I X 

I 

0 : N- 1 

/INTGZ/ 

CODE, INERTIA EFFECTS (INOPT) 

c 

SKOUM,SK 

I 

0 : N- 1 

/INTGZ/ 

CODE, BODIES IN EACH NEST (SETS) 

c 

SL 

I 


/INTG/ 

CODE, ALL POINT MASSES (SETS) 

c 

SIK 

I 

3 ( N+ 1 ) 

/INTG/ 

CODE, CONSTRAINT TOROUE ( I NOPT , N A ) 

c 

SMA 

I 

N 

/INTG/ 

CODE, WHEEL ANGLE COMPUTE ( I NOPT ) 

c 

SMAL 

I 


/INTG/ 

CODE, SMALL ANGLES (INOPT) 

c 

SMCDUM , SMC 

I 

0 : N- 1 

/INTGZ/ 

CODE, ALL WHEELS IN NEST (INOPT) 

c 

SMV 

I 


/INTG/ 

CODE, VARIABLE SPEED WHEELS (INOPT) 

c 

SOK 

I 

N + I 

/INTG/ 

CODE, BODIES HINGE 0 - CM (VDIV) 

c 

SPIOUM,SPI 

I 

0 : Nt 1 

/INTGZ/ 

CODE , PSUEDO INERTIA TENSORS ( I NOPT ) 

c 

SOF 

I 

N + l 

/INTG/ 

CODE, FREE VECTOR AT HINGE (SETS) 

c 

SOL 

I 

N+l 

/INTG/ 

CODE, LOCKED VECTOR AT HINGE (SETS) 

c 

. SR 



/INTG/ 

CODE, ALL RIGID BODIES (SETS) 

c 

SSCN 

I 


/INTG/ 

CODE, UNION OF ALL SCN (VDIV) 

c 

SS IX 

I 


/INTG/ 

CODE, UNION OF ALL SIX (VDIV) 

c 

SVA 

I 


/INTG/ 

CODE, CM VECTORS TRANSFORM (VDIV) 
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Table 1 (Continued) 
Symbol Names Used in N-BOD2 


c 

SVB 

I 


/ INTG/ 

c 

S VD 

I 


/ I N T G / 

c 

SVI 

I 


/INTG/ 

c 

SVM 

I 


/INTG/ 

c 

SVP 

I 

2 ( N+ 1 ) 

/INTG/ 

c 

SVO 

I 

3IN+1 ) 

/INTG/ 

c 

SXM 

I 

3 , N 

/INTG/ 

c 

SXT 

I 


/INTG/ 

c 

T 

R 


/REAL/ 

c 

TEM 

R 

2,160 

LOCAL 

c 

THA • 

R 

33 

/REAL/ 

c 

THAD 

R 

33 

/REAL/ 

c 

•THADD 

R 

33 

EOI VI ETM ) 

c 

THADW 

R 

N 

/REAL/ 

C • 

THAW 

R 

N 

/REAL/ 

c 

TIMEND 

R 


/REAL/ 

c 

TORO 

I 

97 

/INTG/ 

c 

TUG 

R 

3 ( N+ 1 ) 

/REAL/ 

c 

XDIC 

R. 

3,3, IDEM 2 

/real/ 

c 

X I 

R 

3 , 3 , N 

/REAL/ 

c 

X IC 

R 

3 , 3 , N ' 

/REAL/ 

c 

X in 

R 

3 , 3 , N 

/REAL/ 

c 

XMAS 

R 

N 

/REAL/ 

c 

XMCDUM , XMC 

R 

3, 3, 0: N 

/REALZ/ 

c 

XMN 

R 

33,33 

/REAL/ 

c 

Y 

R 

160 

LOCAL 

c 

YD 

R 

160 

LOCAL 

c 

YMCD 

R 

3,2, N+ 1 

EOI V( XMN ) 

c 

XMT 

R 

3 , 3 , N 

/REAL/ 

c 

' ZETA 

R • 

2N 

/REAL/ 


c 

c 


■ V ' 

l ' 


CODE, HINGE VECTORS TR AN SFORM ( VD I V ) 
CODE, DON'T TRANSFORM ( INOPT ) 

CODE, INERTIA .DYAD TRANSFORM. ( VO I V ) 
CODE, SPIN VECTORS TRANSFORM (VD I V ) 
CODE, LOCKED VECTORS TR ANSF ORM ( VD I V 
CODE, FREE VECTORS TRANFORM ( V D I V ) 
CODE, SMALL ANGLE K I NE MAT I C ST I NOPT ) 
CODE, TIME VARY COL 1NER MAT I 1 NOPT ) 
TIME (MAIN) ... 

TEMP STORAGE AREA ( RUNGE ) 
GENEALIZED COORDINATES! INBS, SETUP) 
GENERALIZE COORD RATE (INBS, SETUP) 
GENERALIZE COORD ACC (SETUP, SIMO) 
WHEEL RATE (INBS, SETUP) 

WHEEL ANGLE (INBS, SETUP) 

TIME TO END RUN ( INBS, DYN ) 

UNUSED STORAGE AREA FOR USER 
TIME TO UNCAGE ( I NOPT , UNC AGE ) 
MATRIX OF INERTIA T EN SOR S ( VD I V , X D Y 
INERTIA DYAD BFC ( INBS) 

INERTIA DYAD CFC ( VO I V , TR ANVO ) . 
ZERO I NERT I A . DYAD BFC(WDIV) 

BODY MASS ( INBS) 

TRANSFORM BFC TO CFC ( TRNS I V , TRAN ) 
SCALAR INERTIA MATRIX <VDIV,QFDOT) 
SYSTEM STATE ( EO I V , S E TUP , TORQUE ) 
SYSTEM STATE' DERIV ( S E TUP , TORQUE ) 
DIRECTION COSINE RATES ( DCT ) 

ZERO STATE T RAN S FORMTI ON M AT < I NBS ) 
MODAL DAMPING RATIO (INOPT) 
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FG2 — input error flag. If .TRUE., the input data defines a physically realizable system. 

If .FALSE., a criteria for physical realizability in subroutine INEROR has not 
been satisfied and the job will terminate with an error message. 

FG3 — input error flag. If .FALSE., a code word on an option card read by subroutine 
INOPT has not been recognized and the job will terminate with an error message. 

FG5 — output data flag. Its status is checked at the end of each integration step. If 

.TRUE., a call to the data output subroutine OUTPSP is made. If .FALSE., it is 
not. To change the frequency of data output, the user may change the status of 
FG5 in subroutine TORQUE. The default status of FG5 is .TRUE.. 

LANGLE - 

LDCT 

LEQUIV - 
LETA 

LQFDOT - 
LRATE 
LRTAPE - 
LRUNGE - 
LSETUP 
LSIMQ 

LTORQU . - 
LTRAN 
LTRANV - 
LTRNSI ' - 
LVDIV 
LXDY ' - 
NSTART - 

T — independent variable, defines actual simulation time. Evaluated in 

subroutine RUNGE. 

TIMEND - termination time. At T.GE.TIMEND, the flag FG1 is reset to .FALSE, in 
subroutine DYN: 

For additional discussion, see comment cards inserted into the MAIN program and subroutine 
DYN. 
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DATA INPUT, INPUT/OUTPUT CONTROL 

The first card of the data deck is called from the MAIN program by the statement: 

READ 102, NSTART, LRUNGE, LTRNSI, LVDIV, LEQUIV, LTRAN, LTRANV; LRATE, LXDY 
LETA, LTORQU, LQFDOT, LDCT, LANGLE, LSETUP, LSIMQ, LRTAPE ( 

102 FORMAT (4X, 17L1) 

The data on the card set 17 logic flags that are used to control the mode of input and output. 
The following definitions apply to the logic variables set by the data on this card : 

The first logic variable controls the mode of data input. 

NSTART = .FALSE. A new job: data input will be from cards. The starting time 
for the simulation run will be time zero (T.EQ.O). ,, . 

= .TRUE. A restart job: data input will be from tape. The input tape for 
a restart job is the output tape of a previous job. It is generated, 
by N-BOD2. The starting time for the simulation will be the 
>• termination time of the job for which the restart tape was written. 

The next 1 5 logic variables control the print commands programmed in the various subrou- 
tines. For example:. 

LRUNGE= .FALSE. All print statements coded in subroutines RUNGE will be by- 
passed. 

= .TRUE. All equations coded in subroutine RUNGE will be printed along 
with the numerical magnitudes of the associated variables at the 
time of execution. 

Table 2 lists the subroutines in which the system equations of motion are coded and the as- 
sociated logic variables that control whether or not the equations coded therein should be 
outputted on the line printer. 

The last logic variable of card 1 controls whether or not a restart tape should be written. 

LRTAPE.= .FALSE. Create a restart tape at the termination time of this job. 

— .TRUE, Do not create a restart tape at the termination time. 

If a restart tape is created, the restart data are put into file 2 of the output tape referred to 
as data set 1 1 by the WRITE statements. 

DATA INPUT, SUBROUTINE RSTART 

After the first data card is read, a CALL to subroutine RSTART is made. The precautionary 
step of zeroing all storage locations, except those already loaded by the data on the first input 
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Table 2 


Logic Variables Controlling the Printing 
of the Equations of Motion Coded in the Subroutines 


Logic Variable 

Subroutine 

LRUNGE 

RUNGE 

LTRNSI 

TRNSIV 

LVDIV 

VDIV 

LEQUIV 

EQIV 

LTRAN 

TRAN 

LTRANV 

TRANVD 

. LRATE 

RATE .V 

. - LXDY 

XDY 

LETA 

ETA 

LTORQU 

TORQUE 

LQFDOT 

QFDOT 

LDCT 

DCT 

LANGLE 

ANGLE 

LSETUP 

'• SETUP 

LSIMQ 

SIMQ 


card, is performed upon entry. A check on the status of the logic variable NSTART is then 
made: • „ . ;.. , ■; „-i-~ 

IF (NSTART .EQ. FALSE), . ’ / 

a return to the main program is immediately made. The data to be read in will be from cards 
and will define a new job. * 

gn-L-yu-.?. ■ IF (NSTART .EQ. TRUE), r- . . .. . - •• 

the data .to. restart ; an old job .will be. read according to the read statements coded in subrou- 
tine RSTART. The restart tape is read according to the following statements: 

READ (10, 102) Y 
READ (10, 102) YD 
READ (10, 101) NEQ 

READ (10, 102) (DUMMY (I), I =T, IDEM9) 

READ (10, 102) (RINIT (I), I = 1 , IDEM7) 
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READ (10, 102) (RZINIT (I), I = 1, IDEM8) 

. READ (10, 101) (UNIT (I), I = 1 , IDEM5) 

READ (10, 101) (IZINIT (I), i = 1, IDEM6) 

READ (10, 101) (UNIT (I), 1 = 1, IDEM4) 

101 FORMAT (16 Z 8) 

102 FORMAT (8 Z 16) 

These statements read the restart tape exactly as it was written. The usei has no control over 
the writing or reading of the restart tape other than by the logic control variable LRTAPE 
that defines whether or not it should be created at the time of run termination. 

< i 'i t . * ; J .• ' ; / ' * f : • 

At the end of any job that calls for a restart tape to be generated, the restart data are put in 
file 2 of the output tape which is data set 11. To execute a restart job, the program assumes 
that the appropriate job control statements have been provided that will position the restart 
tape (now data set 10) at the start of file 2 before the execution of the first READ input 
tape instruction. (See the comment cards in subroutine RSTART and the job control re- 
quirements discussion in the following section.) 

After the restart tape has been read, the last input card required for a restart run is read by 
the statement: : 

READ 103, TIMEND 

103 FORMAT (D15.5) ' 

in RSTART where 


TIMEND = termination time for present job. 


This read statement is executed only on a restart job. Upon exit from RSTART, return is 
made to the start of the numerical integration loop in the MAIN program. The job then 
proceeds as if it had never been previously terminated. There are no more data input cards 
required for a restart job. 


PROGRAMMER'S GUIDE TO SUBROUTINE RSTART 


There is no actual computation carried out in subroutine RSTART. Its functions are: 

■■ • Zero all storage location's used by N-BOD2 before any computation is done. 

’ ft r-r r r\-i‘ f-; 4 -r- ~ .*£.•{•* f vjr*rTvT **') * O ” ?’ ■ ’ w- " ' ■ 1 I A ^ i '*• t 

• Read the restart tape so that computation may be reinitiated at the termination 
time of a previous run. 

' • Write the restart tape so that computation may be restarted at a later data. 

For further detail, see the comment cards inserted in the subroutine RSTART. 
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To zero out all common blocks, the size of each must be defined. Thus: 

IDEM4 = number of logical words in /LOGIC/ 

j IDEM5 = number of integer words in /INTG/ 

IDEM6 = number of integer words in /INTGZ/ 

IDEM7 = number of real words in /REAL/ 

IDEM8 = number of real words in /REALZ/ 

IDEM9 = number of real words in /DUMMY/ 

These parameters are defined in subroutine RSTART and must be changed if any of the 
primary labeled common blocks are extended or modified. The user is referred to the pro- 
gram listing to note the method used to zero the common blocks. 

To make use of the restart capability, the user is required to provide appropriate machine- 
dependent job control statements. 

N-BOD2 is programmed to put all user-desired output data in file 1 of data set 1 1 and to 

put all of the restart data in file 2 of data set 1 1 . D ata set 1 1 becomes the restart tape.. 

( 

To restart the job, the restart tape becomes data set 10. The appropriate job control state- 
ments must be provided to position it at the start of file 2 prior to the execution of the 
first read tape instruction of the program. 

Lm 

For a restart job, the author has found it convenient to provide the job control statements 
that copy, prior to job execution, File 1 of data set 10 onto file 1 of data set 11. Data set 
10 will then be positioned at the start of file 2 and, at the end of the restart job, file 1 of 
data set 1 1 will contain a continuous record of the output data from time zero. Further- 
more, the old restart tape, data set 10, will not have been destroyed. 

DATA INPUT, SUBROUTINE INBS 

IF (NSTART .EQ. FALSE)*, 

a call to the subroutine INBS is made immediately after the program returns to the MAIN 
program from RSTART. In INBS, the input data required to describe the basic simulation 
model are read in from cards. 

As in References 1 and 2, the labeling of a system of N bodies (rigid bodies + flexible bodies 
+ point masses) and M symmetric wheels must adhere to the following rules: 

• Bodies must be given distinct integer labels ranging from 1 to N inclusive. The 
labeling must be such that, along any topological path extending from body 1 to 
a limb end, the body labels are of increasing magnitude. 


*Condition code for a new job. 
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• Symmetric wheels must be given distinct integer labels ranging from 1 to M in- 
clusive. These may be randomly assigned. 

• Body 1 is treated as the principal body of the system. 

The labeling of hinge points between contiguous bodies is done by the computer according 
to the following rule: 

• Hinge point K-l is the point of connection between body K and the chain of bodies 
extending to it from body 1 . 

Figures 3 and 4 are provided as visualization aids. Figure 3 is the example used in Reference 
1 to illustrate the defined labeling convention. Figure 4 shows the exact position and labeling 
of each' of the position vectors defined for the system. 

The following definitions are used in the coding of subroutine INBS. The total number of 
bodies and wheels that make up the simulation model are defined by: 

NBOD — total number of rigid bodies, flexible bodies, and point masses 

NMO — total number of symmetric wheels 

also defined is the constant 

NB1 = NBOD + 1 

As a direct consequence of the established labeling convention, the system topology can be 
uniquely defined by the one dimensional arrays: 

JCON(K) Body label of the body connected to body K at hinge 

for K = 2,3, ... , NBOD point K-l. Relative to body 1, it is the Body inboard of 

body K. 

JCON(l ) = 0 implies body 1 is contiguous to the inertial frame of 

reference. 

MO(M) Body label of the body in which symmetric wheel M is 

for M = 1 ,2, . . . , NMO is imbedded. 

The physical nature of each body, its mass and the number of kinematic constraints between 
contiguous bodies, are defined by: " : ' 

RBLO(K) = .TRUE. Body K is either a rigid or a flexible body. For N-BOD2, 

- - Body 1 and all bodies not at a limb end must be rigid. 

= .FALSE. Body K is a point mass. 

for K = 1,2,. .., NBOD 

XMAS(K) Total mass of body K including mass of all symmetric 

for K = 1 ,2, . . . , NBOD wheels which are imbedded within it. 
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Figure 3. Labeling scheme for 10-body example. 
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Number of kinematically constrained rotational degrees 
of freedom between body 1 and an inertially fixed frame 
of reference. 

for K = 2,3, ... , NBOD Number of kinematically constrained rotational or trans- 
lational degrees of freedom between body K and body 
JCON(K). 

for K = NBOD+1 Number of kinematically constrained translational degrees 

of freedom between body 1 and the inertially fixed frame 
of reference. 

( 0 implies 3 degrees of relative freedom 
PCON(K) j 1 implies 2 degrees of relative freedom 

for K = 1 ,2, . . . , NBOD+1 " j 2 implies 1 degree of relative freedom 

I 3 implies no relative motion allowed 

The equations of motion have been derived in a vector-dyadic format and are valid for all' 
frames of reference. To numerically solve these equations, it must be possible to express any 
vector or tensor relative to any desirable frame of reference. 

The equations of motion are derived relative to an origin that is fixed in an inertially fixed- 
reference system. The user is required to pick an inertial origin and to define an orthogonal : 
reference frame there. All translational and rotational motion of body 1 is computed rela- 
tive to this inertially fixed -reference frame. 

Let 

(X 0 , Y Q , Z 0 ) = coordinate axes of the inertially fixed-reference frame 
N-BOD2 assumes that if: 

PCON (NBOD + 1 ) = 0 Body 1 unconstrained in translation 

PCON (NBOD + 1 ) = 1 Body 1 constrained to translate in the X Q , Y 0 plane 

PCON (NBOD + 1 ) = 2 Body 1 constrained to translate in the X Q direction 

;. >» ^PCON (NBOD-+ 1) = 3 Body 1 totally 'con strained' in translation 

In addition to the inertial reference frame, body fixed-reference frames must also be defined. 
Consequently, a body K fixed-reference frame is defined at hinge point K-l ; K = 1,2,... 
NBOD. The orientation of the body K fixed-coordinate axes is arbitrary and to be defined 
by the user. To simplify the input of initial kinematic conditions, it is desirable to define 
a zero state for the system. All relative motion between contiguous bodies can then be meas- 
ured relative to this state in terms of a few physically meaningful relative displacement para- 
meters. 


PCON(K) 
for K = 1 
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The following set of transformation matrices completely defines the relative orientation of 
all reference frames when the system is in the zero relative displacement state. 

[XMT (I, J, K)] — transformation matrix used to transform vectors from 

body K to body.JCON(K) fixed coordinates when the 
system is in its zero relative displacement state 

*XMT (1 ,1 X) XMT(1,2,K) XMT (1,3, K) 

[XMT(IJX)] = XMT (2,1 X) XMT (2,2X) XMT (2,3 X) 

_XMT (3,1 X) XMT (3,2X) XMT(3,3X) 

where 

K = 1/2,.. . , NBOD 

If K = 1, the inputted transformation matrix transforms vectors from body 1 fixed coordinates 
to inertial fixed coordinates. 

The origin of the body K fixed-reference frame is always at hinge point K-l ; K = 1 , 2, . . . , 
NBOD. If body K, K = 2, 3, . . . , NBOD, is a point mass, a transformation matrix is not in- 
putted. The axes of the body fixed-reference frames are defined by the computer to be re- 
spectively parallel to the axes of the body JCON(K) fixed^-eference frame. 

The components of all inertia tensors and position vectors required to describe the physical 
size and rotational inertia characteristics of the simulation model are inputted relative to the 
body fixed-reference frame in which they are fixed. That is: 

[XI (I, J, K)] - components of the inertia tensor for body K and all despun 

for K = 1 , 2, . . . , NBOD wheels contained therein about the body’s center of mass, 

relative to the body K fixed-reference frame (assumed to be 
zero if body K is a point mass). 

"XI (1,1 JK) XI (1 ,2,K) XI^UX) 

[XI(UX)] = XI (2,1 X) XI(2,2X) X1(2,3X) 

.XI (3,1 X) XI (3 2 X) XI(3,3X) 

CA (I, K) — components of the vector from hinge point K-l to the 

for K = 1 , 2, . . . , NBOD center of mass of body K (zero state location if body K is a 

point mass), relative to the body K fixed-reference frame. 

CA (1 X) 

CA (2X) 

CA (3X) 
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... CB (I, K) ' 

. forK = 0 — reserved for the components of the vector from the iner- 

. tial origin to the composite system center of mass. (Not 
needed for computation and hence not computed, may 
be user-defined if desirable.) 

- for K = 1, 2, . . ., NBOD — components of the vector from hinge point JCON(K)-l 

to hinge point K-l , (from inertial origin if K = 1 ), relative 
, to the body JCON(K) fixed-reference, frame 

I CB(IJC) \ 

{CB (IJC)f = J CB (2,K) 

■ CB (3 JC) ' 

Note: Special provision has been made in the coding of N-BOD2 to accept the 
subscript 0 in certain arrays such as CB. Furthermore, to avoid numerical 
computation problems, it is advisable to avoid placing the inertial origin 
at a distance that is many orders of magnitude greater than the diameter 
of a sphere which could contain the entire simulation model. 

The previously defined integer array PCON(K), K = 1 , . . . , NBOD+1 , specifies the number of 
kinematic constraints that exist between contiguous bodies and between body 1 and the iner- 
tial reference. The logical array RBLO(K), K = 1, 2, . . . , NBOD, can be used to determine 
whether relative motion between the bodies K and JCON(K) is rotational or translational. 

Body 1 may have both rotational and translational degrees of freedom relative to the inertial 
reference. Rigid and flexible bodies may have only relative rotational degrees of freedom 
while point masses may have only relative translational degrees of freedom. N-BOD2 assumes 
that relative rotational motion may be adequately modeled by either a 0-, 1-, 2-, or 3-degree-of- 
freedom gimbal, while relative translational motion may be either 0, 1, 2, or 3 dimensional. 
Both the directions about which, or along which, motion is free of kinematic constraints and 
the directions about which, or along which, motion is kinematically constrained must be 
defined. 

These directions are defiped by a set of exactly NBOD+1 triads of unit coordinate vectors. 
These coordinate vectors are defined to be either free coordinate vectors (implying that mo- 
tion is free about or along the directions defined b’y them) or locked coordinate vectors 
(implying that motion is locked or kinematically constrained about or along the directions 
defined by them), The user will be required to define two of. the three coordinate vectors;. 
the third will be internally generated by a vector cross product based upon conditions of. 
orthogonality. 

The integer array PCON(K), K = 1 , 2, . . . , NBOD+1 , defines the mix of free and locked co- 
ordinate vectors in each of the NBOD+1 triads. It also provides a convenient tool for creat- 
ing a labeling sequence for the free and locked coordinate vectors. The labeling will be done 
by the computer. 
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It is a sequential numbering algorithm that starts with the coordinate vectors associated with 
relative rotational motion of body 1 , proceeds sequentially up to body NBOD, and ends with 
the coordinate vectors associated with the description of the translational motion of body 1 . 

Let 

{QF (I, M)[ = components of the unit free coordinate vector M relative to the reference 
frame in which it is fixed. 

I 

|QL (1, L)| = components of the unit locked coordinate vector L relative to the refer- 
ence frame in which it is fixed. 

The mix of free and locked coordinate vectors at hinge point K-l and their labeling sequence 
are defined as follows for K = 1 , 2, ..., NBOD+1 : 

• For PCON (K) = 0 the mix of coordinate vectors at hinge point K-l is 

j QF (I, M)} .{QF (I, M + l)f , {QF (1, M + 2)| 

• For PCON (K) = 1 the mix of coordinate vectors at hinge point K-l is 

;■ |QF (I, M)| , |QF (I, M + 1)| , |QL (I, L)} . 

• For PCON (K) = 2 the mix of coordinate vectors at hinge point K-l is 

|QF (I, M) } , IqLCI, L)j , |QL(I, L+ l)f . 

• For PCON (K) = 3 the mix of coordinate vectors at hinge point K-l is 

{ QL (I, L) } , j QL (I, L + 1) } J |QL (I, L + 2) } • 

where for any K = 1 , 2, . . NBOD +1 

K-i 

M = 1 + 2 (3 " PCON 0)) 
i= 1 
K#1 



K-l 

L = 1 + ^2 PCON (i) 

r . ( 4= 1 - 

K*1 


One of several'di'/ferent kinematic conditions can exist at each hinge point. The user must 
adhere to the following rules when specifying the coordinate of the free and locked coor- 
dinate vectors in each of the NBOD+1 triads: 


• If RBLO (K) = .TRUE, for any K = 1 , 2, . . . , NBOD, the coordinate vectors are 
associated with gimbal axes. Table 3 defines for this case the coordinate frames 
in which the free and locked coordinate vectors are defined. 
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• If RBLO (K) = .FALSE, for any K = 2, 3, . . . , NBOD, the coordinate vectors de- 
fine the directions along which relative translational motion of point mass K is 
free and along which it is constrained. The origin of this triad of coordinate vectors 
is the zero position of the point mass K that is defined by the components of the 
center of mass vector {CA (I, K)}. Table 4 defines the coordinate frame in which 
the free and locked coordinate vectors are defined. 

• If K = NBOD+1 , the coordinate vectors define the direction along which the center 
of mass of body 1 is free to translate. These directions are defined by the computer 
based upon the number of kinematic constraints defined by PCON(NBOD+l). 

Table 5 defines the coordinates of the unit coordinate vectors relative to the iner- 
tially fixed reference. These are set by the computer. 

The initial state of the simulation model can now be defined by specification of initial dis- 
placements and rates about or along the free coordinate vectors whose direction defines the 
directions of positive displacement. Let 

THA (M) = initial relative displacement about or along the free coordinate vector M 

THAD (M) = initial relative rate about or along the free coordinate vector M 

The user need not be concerned with defining initial values for transformation matrices since 
it is done by an internal computer computation. 

Table 3 

Coordinate Frames in Which Free and Locked 
Coordinate Vectors are to be Defined for 
' ' RBLO (K)= .TRUE.; K= 1,2,. .. ,NBOD 


Vector i 

\ 

PCON (K) 

0 

1 

2 

3 

|QF (I, M)| 

ICON (K) 

JCON (K) 

JCON (K) 


{QF (I, M + 1)} 

Intermediate 

M '-n-.ii. 

J 


{QF (I, M + 2)| 

K 

- 1 



|QL (I, L) \ 


Intermediate 

K 

K 

|QL(I,L+1)} 



K 

K 

{QL(I, L + 2)[ 




K 


) ‘ 













Table 4 

Coordinate Frames in Which Free and Locked 
Coordinate Vectors are to be Defined for 
RBLO (K) = .FALSE.; K = 2, 3, . . . , NBOD 


Vector 

. 

PCON (K) 

0 

. . 1 

2 

.3- 

{QF (1, M) | 

K 

K 

K 


jQF(l,M+l)| 

K 

K 



|QF (1, M + 2){ 

K 




|QL(1,L)[ 


K 

K 

K 

{QL(l,L+l)[ 



K 

K 

|QL (1, L + 2)| 




K 


Table 5 

Coordinates of the Unit Coordinate Vectors Defined 
at the Inertial Origin Along Which Translational 
Motion of Body 1 is Measured; 

K = NBOD + 1 


Vector 

pcon no 

0 

1 

2 

3 

|QF (I, U)\ 

L 1,0,0 J 

L 1,0,0 J 

L 1,0, 0 J 


{QF (I, M + 1)} 

L 0, 1, 0 j' 

L 0, 1, 0 J 



{QF (I, M + 2){ 

L 0, 0, 1 J 




{QL (I, L)} 


L 0, 0, 1 J 

L 0, 1, 0 J 

L 1,0,0 J 

{QL (I, L + 1)| 



L 0, 0, 1 J 

L 0, 1, 0 J 

{QL (I, L + 1)} 

- 

. 



L 0, 0, 1 J 




To define the characteristics of each of the symmetric wheels imbedded within the simula- 
tion model, the following definitions are made: 


|HM (I, M)} — components of a unit vector along the spin axis of symmetric wheel 

M relative to the body MO(M) fixed-reference frame. Its direction 
defines the direction of positive rotation. 


PLM (M) — rotational inertia of the symmetric wheel M about its spin axis. 

THAW (M) - initial angular position of the wheel M about its spin axis. 

THADW (M) - initial angular rate of the wheel M about its spin axis relative to body 
MO(M). 


The integration step size for the fourth order Runge-Kutta integration package and the time 
for job termination are defined by: 

H — integration step size 

TIMEND — job termination time 


To completely specify the initial state of the simulation model, the above parameters must 
be defined by the user or be internally generated. The following is a listing of the READ 
statements coded in subroutine INBS in order of execution. The data deck must be pre- 
pared accordingly. 


»«»**«»*«*» READ STATEMENTS FOR SUBROUTINE INBS IN ORDER OF EXECUTION ***»»*«**» . 

c . i 

:C INITIALIZE FREE AND LOCKED COORDINATE VECTOR LABELS 

M- = 1 . •. ... 

■ ■ -L = 1 ' 

*«.»«»*#«* FIRST CARD read by inrs is. second card OF DATA DECK 
; R FAD mo, NBOD' 

C ... ' . 

***>»****** READ EXACTLY NBOD SETS OF' BODY DATA, ONE PER BODY 

00 1 K = l , NBOD . 

READ 105, N.IMESSI J),J=l',18I 

IFIN.NE..KI ERROR, CARD OUT OF SEQUENCE, PRINT MESSAGE. HALT' 

C MESS! J) , J=l, 18 ALPANUMERIC DESCRIPTION OF BODY N, PRINTED WITH DATA ECHO 

READ 101, RBLOI K) , JCON ( K ) ,PCON( K I , XMASIK ) 

,. IFIRHLOIK) ) GO TO Z BOOY K IS A RIGID OR FLEXIBLE BODY 

GO TO B BODY K IS A POINT MASS 
2 READ ID?, ( ( XI ( I/j t K) , J=l,3) ,1 = 1,3) 

READ 10?, ( ( XMT( I , J,K ) , J=1 ,3 ) , I =1 , 3 ) 

8 READ 10?, (CA< J,K) , J=l,3l 
READ 10?, (CRtJ'K) , J*l,3) 

C COMPUTE LABELS FOR FREE AND LOCKED COORD 1 NAT E . VEC TORS INTERNALLY , * . * 

1 F ( K . E 0 , 1 ) GO T 0 T-? * 

M = M * 3 - PCON ( K — 1 ) 

L = L ♦ PCON(K-l) . s. r . 

12 GO TO ( 13, 14, 15*47'/ PCONfck 

13 CONTINUE THREE DEGREES OF RELATIVE FREEDOM FOR BODY K 

READ 102, (0F( J,M> , J=l,3) 

READ 102, (OF I J,M + 2l , J= 1 , 3) 

READ 102 * ( THA ( J) , J = M,M + 2 I 
READ 102, (THAO(J) *J=M»M+2) 

GO TO 1 END OF DATA FOR BODY K 

14 CONTINUE TWO DEGREES OF RELATIVE FREEDOM FOR BODY K 

READ .102, ( OF ( J ,M ) , J= 1 , 3 ) 

READ 102, (QF( J,M+1) , J= 1 , 3 ) 

READ 102, (THAI J) , J=M,M+1 ) 

READ 102, ( THAO! J ) , J=M,M+l ) 

GO. TO 1 END OF DATA FOR ROOY K 
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15 CHNTINUE ONE DEGREE OF RELATIVE FREEDOM FOR BODY K 

READ 102, ( OF ( J , M ) , J= 1 ,3 ) 

R FAD 102, I OL I J,D , J=l,3) 

READ 102, THAI M ) 

READ 102, THAD(M) 

GO TO 1 END OF DATA FOR RODY K 
17 CONTINUE ZERO DEGREES OF RELATIVE FREEDOM' FOR BODY K 

READ 102, (OM J»L) • J-1,3) 

READ 102, IOLU.L+1 > . .1=1 .31 
r,n Tn 1 END OF DATA FOR rt l If) Y K 
I f.HNT I Ml IE 

**$*$$*$** ALL BODY DESCRIPTIVE DATA IS IN MEMORY NOW 

, c 

*****$**** RE AD TRANSl.AT ION CONDITIONS FOR BODY 1 
READ 100. PCONI NROD+1 I. 

. . M = M 4- > 3 - PCON(NROD ) • ‘ ■ 

READ 102, (THAO( ,1) , J = M,M+2-PC0N(NH00+l ) I 

C 

read ALL SYMMETRIC WHEEL DATA 
READ 100, NMO 

DO 1(5 1=1, NMO GO TO 1ft IF NMO.EO.O 
READ 1 0 A , MI)( I ) , (HM( .1, I ) . Jr 1 ,3 > 

RF AD 10ft, PLM ( I ) , ( MESS ( .1 ) , J= 1 * 1 ft I 

KF AD 102, THAW ( I ) ♦ THADW ( I) ' ~ 

lft CONTINUE 

ALL WHEEL data is IN MEMORY 

c 

$**$***$#* MEAD STEP SIZE and TIME TO END SIMULATION 
READ 102, H.TIMEND 

C END OF DATA TO HE READ BY SUBROUTINE INRS 

f. • 

***** ***** FORMAT STATEMENTS USED 
too FORMAT (15) 

M01 FORMAT (L5,2I5,D15.5) 

102 FORMAT I 301 5.5) 

10A FORMAT (15,3015.5) 

105 FORMAT ( I 5 * l H A4 ) 

'• 10ft- FORMAT (015. 5, 1 ft A4 ) 


PROGRAMMER'S GUIDE TO SUBROUTINE INBS 

The primary function of subroutine INBS is to read the data cards that define the basic sim- 
ulation model and its initial kinematic conditions. This has been thoroughly discussed in 
the section “Data Input, Subroutine INBS.” A cursory glance at the subroutine listing will 
show that it is also programmed to provide an echo of the input data and to compute a few 
additional variables that will be needed for the succeeding computations. 

The following variables defined in table 1 are either first introduced or used extensively in 
subroutine INBS. The programmer is referred to the comment cards inserted therein and 
the following for detailed definitions: 

CA (I, K) —"se’e section “Data Input, Subroutine INBS.” 

CB(I,K) - see section “Data Input, Subroutine INBS.” . ■■ , ■ 

— computed variable. Used to compute body 1 center of mass location 
relative to inertial origin 

(CBN (1)1 ( 0 ) 

<CBN(2)> = < 0 > ifPCON(NBl) = 0 

(CBN (3) ) ( 0 ) 
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CBN (I) 



FCON (M) 


H 

|HM (I, M)} 
HMOM (M) 

ICON (K) 
LCON (L) 


MO (M) 
NBOD 
NB1 
NFER 
NLOR 
NMO / 
PCON (K) 
PLM (M) 



< CB (2, 1) > 
(CB(3,1)) 

(CB(1,1)) 
\ CB (2, 1) > 
(CB (3, 1) ; 


if PCON (NB1) = 1 
if PCON(NBl) = 2 
if PCON (NB1) = 3 


code used to define the body label of the body in which free coordinate 
vector M is fixed. 


FCON (M) = K if free coordinate vector M is fixed in body K 

FCON (M) = -(M-l) if free coordinate vector M is the intermediate 
axis of a three axis gimbal 


see section “Data Input, Subroutine INBS.” 


see section “Data Input, Subroutine INBS.” 
relative angular momentum of momentum wheel M 


HMOM (M) = PLM (M) * THADW (M) 
see section “Data Input, Subroutine INBS.” 

code used to define the body label of the body in which locked coordinate 
ordinate vector L is fixed 

LCON (L) = K if locked coordinate vector L is fixed in body K 

= -M if locked coordinate vector L is the axis about which 

relative motion is kinematically constrained on a two 
axis gimbal defined by the free vector M and M+l 


\ see section “Data Input, Subroutine INBS.” 


total number of free coordinate vectors 

... ... .. "'cifSMAflfJOW 

total number of locked coordinate vectors 
| see section “Data Input, Subroutine INBS.” 
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|QF (I, M)f 
|QL(I, L)} 

RBLO (K) 

THA (M) 

THAD (M) 

THAW (M) - 

THADW(M) 
TIMEND 
[XI (I, J, K)] 
XMAS (K) 

[XMT (I, J, K)] - 



see section “Data Input, Subroutine INBS” 

/ 


PROGRAMMER'S GUIDE TO SUBROUTINE INEROR 

Tiie main function of subroutine INEROR is to check the data inputted by subroutine INBS 
for obvious errors. 

The following error checks are made: 

• All bodies must have positive mass greater than zero. 

• The topological tree must be properly labeled; i.e., JCON (K) must be less than 
K for all K where K = 1,2, . . . , NBOD. 

• The number of kinematic constraints must be 0, 1 , 2, or 3. 

• Inertia tensors must be symmetric and have a positive nonzero determinant. 

• Zero-state transformation matrices must be orthonormal. 

If any of the above tests are not satisfied, the flag FG2 is set .FALSE.. Appropriate error 
messages are printed to assist the user in locating the error source, and the job will terminate 
after a return to the MAIN program. 

t .. r t 't • J • 1 ; ' ' • !' f * . **' ' ! ‘ ' 

PROGRAMMER'S GUIDE TO SUBROUTINE SETS 

The main function of subroutine SETS is to interrogate the data inputted by subroutine 
INBS and compute various sets of integers which will enable the computer to avoid redun- 
dant and trivial computation. To save computer storage, code words are created that com- 
pact the desired integer arrays into a single integer code word. Triangular arrays are stored 
as one-dimensional arrays in the memory of the computer. The following variables, defined 
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in table 1, are either first introduced or used extensively in subroutine SETS. The program- 
mer is referred to. the comment cards inserted therein and the following for detailed defini-. 
tions. 

SG — code word used to define the body labels of all gyrostats; i.e., all bodies 

that have one or more imbedded symmetric wheels. 

SI(KN) — one dimensional array of code words used to define the body labels of 
all bodies on the topological path extending from hinge point K-l out- 
, . • , ward to the center of mass of body N, where 

KN = KTO (NBOD, K-l, N) ' 

K =1,2,... , NBOD 

‘ ' ' N > K 

The utility function KTO is used to store the triangular array of code • 
words in a one-dimensional array. 

SK (K-l) — code word used to define the body labels of those bodies contained 

in the nest of bodies K-l ; K = 1,2,..., NBOD. Due to the setup of 
labeled common block /1NTGZ/, SK(0) is stored in the location SKDUM. 

. SL — code word used to define the body labels of all point masses. 

SQF (K) - lowest magnitude free coordinate vector label at hinge point K-l ; K = 

- 1 ,2, ..., NBOD+1 , where 

K = NBOD+1 implies the inertial origin 

and 

SQF (K) = 0 if PCON (K) = 3 

SQL (K) — lowest magnitude locked coordinate vector label at hinge point K-l ; 

K ■ = 1 , 2, ..., NBOD+1 , where 

K = NBOD+1 implies the inertial origin 


SR 


and 

SQL(K) = 0 if PCON (K) = 0 

code word used to define the body labels of all rigid and flexible bodies. 
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DATA INPUT, SUBROUTINE INOPT 

Subroutine INOPT is the second input subroutine called by the MAIN program. The input 
cards to be read by it follow immediately after those read by subroutine INBS jn the data 
deck. 

The program N-BOD2 has been coded to accept a description of the basic simulation model 
by subroutine INBS. Amplifications or modifications to the model or to the equations of 
motion that describe.it are defined by subroutine INOPT. 

In many problems of practical interest, the user will not have to exercise any of the available 
options. In such cases all parameters required for computation,- which could have been user 
defined, are set by default to the values that, in the author’s opinion, are most commonly 
desired. If no options are to be used, INOPT will read only one data card. 

INOPT is programmed to recognize different code words that are used to define which of the 
available options is to be used. The code words are punched on what will be referred to as 
‘‘option cards.” All option cards are read at program point -12 in INOPT by the statement 

12 READ 100, ICD1, ICD2, ICD3, I, NSET, (SI (J), J=1, 10) 

1.00 FORMAT (3A4, 13, 1115) 

Columns 1 through 12 of each option card contain the code word. Table 6 contains a listing 
of all code words, the columns in which the alphanumeric characters must be punched, and 
a brief description of the function of the option. 

Upon recognition of a code word, the program branches to the appropriate point in the pro- 
gram where all required computational and additional READ data operations are carried out. 
Upon completion, the program branches back to program point 12 to read the next option 
card. The cycling back to program point 12 continues until an END OPTIONS option pard 
is recognized. The END OPTIONS card is the last card to be read by INOPT. 

If a code word is not recognized, the flag FG3 will be set .FALSE. , an error message will be 
printed, and return to the MAIN program will be immediately made. 

The following subsections define in detail the various option codes recognized by INOPT and 
their purpose. 

*** Terminate Option Input *** 

1. No Option Required 

If no options are required for the simulation model, the code word NO OPTIONS must be 
punched on the data card immediately following the data cards read by subroutine INBS. 

In this case, all modifiable parameters are set by default. The NO OPTIONS card would, in 
this case, be the only card read by INOPT. 
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2. End Options 

If the user is to make use of one or more options, the last card of the cards to be read by 
INOPT must have the code word END OPTIONS punched on it: If it does not, an input 
error will result and the program will terminate with an appropriate error message. 

*** Optimize Computation Efficiency *t*. 

In orderko optimize computation speed, all unnecessary, trivial, and rediindant computation 
must be avoided. By an interrogation of the input data, numeroiis,set.s of integers can be 
defined that can be used to carry out the above task. It is not possible for the computer to 
pick out “almost trivial” computations; this the engineer must do. By use of particular 
option 'cards, he can literally insert engineering judgment into N-BOD2. 

In practical application, the author has found that usually there are not enough “almost triv- 
ial” terms that can be justifiably deleted to make a significant impact on computation speed. 
Consequently , while the options are available for the user, the author has rarely made prac- 
tical use of most of them. -. 

3. Choice of Frame of Computation 

The equations of motion, as derived, are in a vector -dyadic form and are valid for all frames 
of reference. The user may choose the frame of computation to be either the inertially fixed- 
reference frame or the body 1 fixed-reference frame. All vectors and tensors required for 
computation are stored in memory in computing frame coordinates. The user should define 
the frame of computation to be the reference frame in which he wishes to output most of 
the computed system state variable vectors. - ■ • 

The logic variable INERF is used to define which frame of computation is to be used for 
internal computation. 1 ■; 

INERF = .TRUE, if the frame of computation is to be the inertially fixed-reference 
frame. Recognition of the code word INERTIAL on an option 
‘ ' card will set INERF equal to .TRUE. . • 

INERF =. .FALSE, if the frame of computation is to be the body,l fixed-reference 
n ?.•' r - frame. Recognition of the code word BODY 1 on an option card 
■ ' ‘ ' :. ' will set INERF equal to .FALSE. !. - . ’ 

Default ;' INERF = .FALSE. ’ v V . ' 

Body 1 will be the frame. of computation unless otherwise directed. • 

4. Truncate Computation of Pseudo-inertia Tensors 

The vector-dyadic form of the simulation model’s equations of motion is given in Reference 
1 by equation .88 and in Reference 2 by equation 111. The coefficient matrix on the left- 
hand side of the equation contains numerous inertia and pseudo-indrtia tensors that are 


defined by equations 63 through 70 of Reference 1 . If the simulation model has both large 
and small bodies, some of the small bodies may contribute a nearly trivial amount to the 
pseudo-inertia tensors associated with the nests that contain both the large and the small 
bodies. 

To compute the inertia and. pseudo-inertia tensors defined by equations 63 through 70 of 
Reference 1 , the integer code words SPI(I), 1 = 0,1,..., NBOD-1 , are used in subroutine 
XDY. 

SPI(I) — code word. Used to define the set of bodies contained in the nest I that 

contribute significantly in the computation of the inertia and pseudo-inertia 
tensors associated with the nest I; I = 0, 1, ... , NBOD-1 . 

Upon recognition of the code word ASETX, INOPT makes use of the data in columns 1 3 
through 70 of the option card to redefine the. code word SPI(I). The following definitions' 
apply for this option: 

I = nest number 

NSET =. number of body labels to be defined to be in the set defined 
bySPI(I) 

(SI (J), J = 1 , NSET) = the body labels defined to be in the set defined by SPI(I). 
The code word SPI(I) is created by the operation 

CALL COMPAC (SI , NSET, SPI(I)). 

Default SPI(I) = SK(I); I = 0, 1, ... , NBOD-1 

Unless otherwise directed, all bodies contained in the nest I are assumed to contribute signif- 
icantly to the inertia and pseudo-inertia tensors associated with the nest I. . =• 

5. Truncate Computation of Inertia Cross-Coupling Torques 

In Reference 1 , the inertia cross-coupling torque acting on the nest I can be found from 
equations 79 and 80. In Reference 2, it can be found in equation 92. It is given in the nota- 
tion of these references as 

£ [v^x + 5 x x .( < v c: v + a £ X; A] 

XeSj *- ' " ' J 

where the summation extends over all bodies contained in the nest I. In subroutine ETA, 
the integer code words SIX(I), I = 0, 1 , . . . , NBOD-1 , are used to define which bodies con- 
tribute significantly to the above summation. 
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SIX(I) — code word. Used to define the set of bodies contained in the nest I that 
contribute significantly to the computation of the inertia cross-coupling 
torque acting on the nest I;I = 0,1,..., NBOD-1 . 

Upon recognition of the code word ASETIXC, INOPT makes use of the data in columns 13 
through 70 of the option card to redefine the code word SIX(I). The following definitions 
apply for this option: 

I = nest number 

NSET = number of body labels to be defined to be in the set defined 
by SIX(I). 

(SI (J), J = 1, NSET) = the body labels defined to be in the set defined by jSIX(I). 
The code word SIX(I) is created by the operation 

CALL COMPAC (SI , NSET, SIX(I)). 

Default Unless otherwise directed, all rigid and flexible bodies contained in the nest I are 
assumed to contribute significantly to the inertia cross-coupling torque acting on the nest I. 


NOTE: Point masses have zero contribution and hence their body labels' 
are not contained in any of the sets defined by the code words 
SIX(I); 1 = 0, 1,. . NBOD-1. 


v 

6. Truncate Computation of Centripetal and some of the Coriolis Cross-Coupling Torques 

In Reference 1 , the centripetal and Coriolis cross-coupling forces and torques appearing on 
the right-hand side of equation 88 are defined by equations 75 through 78. In Reference 2, 
the analogous terms are found in equations 100, 107, and 108. 


In the notation of Reference 2, the gyroscopic torque associated, with these effects acting 
on the nest I is given by 


E % 


a x c a 


; I = 0, 1,... .NBOD-l 


AeS. 


where 


C \ = m A 


S (“HO x (“HO x *i) + 2 “H0 x ?) 

ieS. , . \ ' 


0,A-1 

i t 1 


+ W A X 


( ^A X “a) + 2 ^A X ®A ) 


and the summation extends over all bodies contained in the nest I. 
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In subroutine ETA, the integer code words SCN(I) and SCR(I), I - 0, 1 , , NBODU , are 
used to define which bodies contribute significantly to the above summation. 

SCN(I) - code word. Used to define the set of bodies contained in the nest I which 
contribute significantly to the computation of the centripetal and Coriolis 
cross-coupling torques acting in the nest I; I = 0, 1 .... , NBOD-L 

SCR(I) — codeword. Used to define the set of point masses contained in the nest I 
for which their Coriolis acceleration effects contribute significantly to the 
computation of the centripetal and Coriolis cross-coupling torques acting 
on the nest I; I = 0, 1 , . . . , NBOD-1 . • • 

Upon recognition of the code words ASETCEN or ASETCOR, INOPT makes use of the data 
in columns 13 through 70 of the option card to redefine the code words SCN(I) or SCR(I) 
respectively. The following definitions apply for these options: 

I = nest number 

NSET = number of body labels to be defined by SCN(I) or SCR(I), 
respectively. ■ > • * • 

(SI (J), J = 1, NSET) = the body labels defined to be in the set defined by SCN(I) 

or SCR(I), respectively. 

The code word SCN(I) is created by the data on the ASETCEN option card by the operation 

CALL COMPAC (SI, NSET, SCN(I)). 

The code word SCR(I) is created by the data on the ASETCOR option card by the operation 

CALL COMPAC (S 1 , NSET, SCR(I)). 

Default Unless otherwise directed, all bodies contained in the nest I are assumed to con- 
tribute to the centripetal and Coriolis cross-coupling torques acting on the nest I; I = 0, . 

1, . . . , NBOD-1. 


NOTE: The elements of sets defined by the code words 

SCR(I), I = 0, 1 , . . . , NBOD-1 , are only point- 
mass body labels. 

7. Choice of Kinematic Techniques 

The user has the choice of which type of kinematic formulation should be used to define 
the transformation matrices. In the first version of N-BOD2, direction cosine techniques 
were used exclusively. In an attempt to improve computation speed, it was noted that the 
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integration of the equations of motion yielded Euler angles directly. These could be used to 
directly obtain the required transformation matrices and eliminate the need for setting up 
and integrating six direction cosine equations per transformation matrix. It was further 
reasoned that time-consuming trigometric operations could also be dropped if it was known 
that the Euler angles would be small angles. Practical application has shown that the com- 
putational operations required to go from Euler angles or small Euler angles to the transforma- 
tion matrices takes about the same amount of computer time as the operations required to set 
up and integrate the direction cosine equations. 

i These three approaches are available for the user in N-BOD2. The author personally uses 
direction cosine techniques for most simulation work; however, if it is critical that the trans- 
formation matrices maintain orthonormality to a high degree of accuracy, Euler angle tech- 
niques are preferable. There is no significant computational speed advantage associated with 
any of the techniques. The Euler angle and small angle approach requires that the body 
fixed free vectors, about which the Euler angles are measured, be aligned with the coordinate 
axes of their respective body fixed-reference frames; a restriction not imposed in the direc- 
tion cosine approach. 

In subroutine DCT, the direction cosine equations are set up and in subroutine TRAN, trans- 
formation matrices are computed. The code words SD, SEU, and SMAL are used in these 
subroutines to define the particular kinematic approach that is to be used. 

SD = code word. Used to define all contiguous pairs of bodies (JCON(I), I) for 
which direction cosine techniques are used to compute transformation 
matrices. .. . 

SMAL = code word. Used to define all contiguous pairs of bodies (JCON(I), I) for 
which small angle techniques are used to compute transformation matrices. 

SEU = code word. Used to define all contiguous pairs of bodies (JCON(I), I) for 
which Euler angle techniques are used to compute transformation matrices, 

. ■ . i • 

Upon recognition of the code word EULERANG, the data in columns 13 through 70 are 
used to create the code word SEU by the operation 

CALL COMPAC (SI , NSET, SEU). 

Upon recognition of the code word SMALLANG, the data in columns 13 through 70 are used 
to create the code word SMAL by the operation 

CALL COMPAC (SI, NSET, SMAL). 

NOTE: Redundancy is not permitted. Pairs of bodies defined 
by the user to be in either of the sets defined by SEU 
or SMAL will be subtracted from the set defined by SD 
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In columns 13 through 17 of the option cards, 

I = unused 

NSET = the number of pairs of bodies for which the special kinematic 
techniques are to be used. 

(SI (J), J =. 1 , NSET) = the labels defining the pairs. The Jth pair is defined as body 
. JCON(SI(J)) and body SI(J). ■ . 

Default Unless otherwise directed, all contiguous pairs of rigid or flexible bodies are con- 
tained in the set defined by SD. Both SEU and SMAL are empty sets unless otherwise di- 
rected. 

8. Suppress Selected Coordinate Transformations 

All nontrivial body fixed vectors and tensors are transformed to computing frame coordinates 
four times per integration step. Under certain conditions, this can be a wasteful operation.. 

If it can be determined that the components of all body fixed vectors and tensors of certain 
bodies are essentially time invariant in computing frame coordinates, it makes no sense to 
retransform them at every integration step. ... . ;s 

The avoidance of these redundant transformations is controlled by the code word SVD in 
VDIV and TRANVD. 

SVD — codeword. Used to define the set of all bodies for which body-fixed vectors 
and tensors are time varying in the frame of computation. 

Upon recognition of the code word VTINBOD, the data in columns 13 through 70 are used 
to create the code word SVD by the operation 

CALL COMPAC (SI, NSET, SVD). 

In columns 13 through 70 of the option card, 

I - unused 

NSET = the number of bodies for which body-fixed vectors and ten- 
; . , sors are time varying in the frame-o.f .computation. .- • . s , 

(SI (J), J = 1, NSET) = the body labels defined to be in the set defined by SVD. 

Default Unless otherwise defined, all body labels are contained in the set SVD. If the com- 
puting frame is the body 1 fixed-coordinate frame, body label 1 is automatically subtracted 
from SVD. 


NOTE: Body labels associated with point masses are included 
in SVD since their nominal center-of-mass positions 
are given in their respective body-fixed coordinate 
system. 
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9. Suppress Recomputation of Elements of Coefficient Matrix of Inertia Tensors 

In References 1 and 2, the matrix X is a symmetric (NB1) X (NB1) matrix of inertia and 
pseudo-inertia tensors, the elements of which. are given by equations 63 through 70 in Ref- 
erence 1 . Under certain conditions, one or more of the columns (down to the diagonal) of 
this matrix will have nonzero entries that are nearly constant in time. Unless otherwise di- 
rected, the. program recomputes these terms four times per integration step. The avoidance 
of these redundant computations ^subroutine XDY is. controlled by the code word SXT. 

SXT — code word. - Used to define the columns of the matrix X of psuedo-inertia 

' tensors that have time-varying elements. X is symmetric and columns referred 
to extend down only to the diagonal element. Column NB1 always is taken as 
having time-varying elements. The elements of column K, K = 2, . . . , NBOD, 
give the inertia contributions of the nest K- 1 to the system’s equations of motion. 

Upon recognition of the code word CO LX, the data in columns 13 through 70 are used to 
create the code word SXT by the operation • ■ ' ' 

CALL COMP AC (SI, NSET, SXT). . . .. . 

In columns 13 through 70 of the option card 

I = unused 

NSET = the number of columns to have time-varying elements (not 
’ ' including column NB1, NB1 = NBOD + 1). 

(SI (J), J = 1, NSET) = the column numbers of the columns of X that will have time-, 

• •* varying elements. 

Default Unless otherwise defined, all body labels are contained in the set SXT. This im- 
plies that all nonzero elements of X will be assumed to be time varying. 

10. Suppress Computation of Relative Displacements 

A redundancy exists in the computation of kinematics. All transformation matrices may be 
computed by a solution of direction cosine equations. Relative displacement angles, which 
provide basically the-same information, - are found by an integration of Euler rate equations. 

If direction cosine methods are used, it usually is not, necessary to compute all relative dis- 
placement angles since their,only use is for a description of torques acting between bodies 
that' area function of -relative displacement angle (springs) and for output display. Accord- 
ingly ) the <user;m ay selectively supress their computation. 

The avoidance of the computation of relative displacement angles is controlled by the integer 
array SFR in subroutines SETUP and ANGLE. 

NFRC ' — total number of free coordinate vectors about or along which rela- 
tive displacement is to be computed. 


41 



' SFR (I) — the labels associated with the free coordinate vectors about or along 

which relative displacement is to be computed. 1=1,2,..., NFRC 

Upon recognition of the code word FREE, the data in columns 13 through 70 are used to 
define the elements of the set SFR. In columns 13 through 70 of the option card, 

I = unused .. 

NSET = the number of free coordinate labels to be defined on this 

card for inclusion is the set SFR. ' -■■■> r: ■ '■ 

(SI (J), J = 1 , NSET) = the free coordinate labels to be defined to be in the set SFR. 

The input data format statement allows a maximum of 10 free coordinate vector labels to 
be defined per option card. Several option cards with the code word FREE may be used if 
required. 

Default Unless otherwise defined, all relative displacement rate equations will be set up 
and integrated. 


NOTE: INOPT is programmed to prohibit the user from supress- 
ing the computation of angles required for use in conjunc- 
tion with either the Euler angle or the small angle option. 
It also prohibits the suppression of the computation of the 
coordinates that define body 1 translational displacement 
or point mass displacement. 


11. Suppress Computation of Symmetric Wheel Angular Position 

In spacecraft application, the integration of the symmetric wheel rate equation to ascertain 
the angular position of a mark on a symmetric wheel is usually a time-consuming and waste- 
ful practice since its rates are usually high relative to the spacecraft frequencies of interest. 
At times, however, it may be important' to know the wheel’s angular position. 


The determination as to which wheel rate equation should be integrated is controlled in sub- 
routine SETUP by the integer array SMA. 

NMOA — total number of symmetric wheel rate'equations to be integrated. 


\ny, i, tn- SMATI) — r the labels of the symmetric wheels for. which wheel angular position 

■ ■ • '**»* - • <••• " • » T'.ip V O’fjiy fsNV; .*»<••'■* '*rx «tnrt?«*on'i<rr rin 

is to be computed. I = T, 2 r . i '. , NMOA 


ott rmclj 


Default Unless otherwise directed, none of the wheel rate equations will be integrated. 

Upon recognition of the code word MOMANGLE, the data in columns 13 through 70 are used 
to define the elements of the set SMA. In columns 13 through 70 of the option card. 


I = unused 
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NSET = the number of symmetric wheel labels to be defined on this 
card for inclusion in the set SMA. 

(SI (J), J = 1 , NSET) = the symmetric wheel labels to be defined to be in the set 

The input data format statement allows a maximum of 10 wheel labels to be defined per 
option card. Several option cards with the code word MOM ANGLE may be used if desired. 

12. Computation of Forces and Torques of Constraint 

The code words CFORCE and LOCK are recognized and may be used to redefine the ele- 
ments in the integer array SFK and SLK, respectively. These arrays were to be used to de- 
fine which forces and torques of constraint should be computed. This option has not been 
coded and is not available for users of N-BOD2. > 

Default 

NCTC =0 

' NFKC =0 

SFK =0 

SLK = 0 

*** Expand Modeling Capability *** 

13. Specification of Constant Speed Wheels 

Wheels that are controlled to spin at a constant speed should be modeled as constant speed 
wheels. Computationally, this reduces the order of the equations of motion of the system 
and eliminates the need for defining a control system that will maintain constant wheel rate. 

The code word SMV is used in subroutines QFDOT and SETUP to define which wheels are 
to be treated as variable speed wheels. 

SMV — code word. Used to define which of the symmetric wheels are to be treated 
as variable speed wheels; all others are treated as constant speed wheels. 

NMV - total number of variable speed wheels. 

Upon recognition of the code word VARWHEEL, ; the data in columns 13 through 70 are used 
to create the code word SMV by the operation 

CALL COMPAC (SI , NSET, SMV). 
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In columns 13 through 70 of the option card, 

I = unused 

NSET = number of wheels to be defined as variable speed wheels. 

(SI (J), J = 1 , NSET) = the labels of the variable speed wheels. 

Only one VARWHEEL option card is permitted. 

Default Unless otherwise directed, all symmetric wheels are assumed to be variable speed 
wheels. 

14. Caging and Uncaging of Degrees of Freedom 

In order to simulate the deployment of spacecraft appendages, it is desirable to have the 
capability to increase the number of allowable degrees of freedom during a simulation run. 

A “caged degree of freedom” is a degree of freedom that is not allowed for a predefined 
time. The uncaging of degrees of freedom at predefinable times allows the user to simulate 
deployment transients. 

The following definitions are used: 

SCG _ — total number of caged degrees of freedom at time zero. 

SC (I) - labels of the free coordinate vectors about or along which relative motion 

will be constrained fora predefined time. 1=1,2,..., SCG 

•nr 

TUG (I) — time at which motion about or along free coordinate vector SC(I) will 
be allowed (uncaged). I = 1 , 2, . . . , SCG 

NOTE: All uncaging takes place with zero initial relative 
rate. The coding to account for the impulse effect 
that is associated with uncaging with an initial 
relative rate has not been included in N-BOD2. 

Upon recognition of the code word CAGE, the procedure for inputting the data required to 
use this option is started. In columns 13 through 70 of the option card, 

I = unused 

NSET •= SGG, the total number-of -degrees 1 of freedom caged at^time 
zero. 

(SI (J), J = 1, NBOD) = unused. 


44 


Their labels and times for uncaging are then read according to the following: 

READ 101, (SC(I), TUG(I), 1=1, SCG) 

101. FORMAT (15, D 15.5) 

After these data cards are read, a check is made to make sure that the initial rates associated 
with the caged degrees of freedom are zero. If not, they are reset to zero. 

Default Unless otherwise directed, all degrees of freedom are assumed uncaged at time 
zero. ' ' - - 


15. Flexible Body Option 

The user is encouraged to first refer to the section entitled “Flexible versus Rigid Body 

, - * - ■ 

Modeling” in Reference 2 before making use of the flexible body option. Contained therein 
are equations that provide a guide for estimating the required number of vibration modes 
and a discussion of the assumptions implicit in the formulation of the coupled flexible body 
equations of motion. 

N-BOD2 accepts only resultant mode dependent parameters. Their description is based 
upon the assumption that a finite element model of the flexible body can be defined.* 

The following definitions are taken directly from Reference 2 and are used to define the 
required resultant mode dependent parameters. ' 


m. . = mass of element i of body X 


0< R. k = inertia tensor of element i of body X about its own center of mass in the 
undeformed state of body X 

°r., = position vector from hinge point X-l to the undeformed center-of-ma§s 

1, A 

position of the element i of body X 


°\ 


position vector from hinge point X-l to the undeformed center-of-mass 
position of body X .. . 


= nth normal mode displacement vector for the element i of body X 


?- !( nfAjnormal;mode t rptatipn vector for the element i of body X 


m x = total mass of body X 

= Kronecker delta function 

m ,n 

N. = total number of elements i used in the finite element model of body X 

*The user is also referred to Appendix B in which a NASTRAN DMAP program and a preprocessor program are listed. The 
output of these two programs define the resultant mode dependent parameter required. 
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The normalization condition imposed upon the modes is 


■ ]£ ["V W • Vi.X + ' (Xi.X ‘ Vi a)] = m X 6 m,n 

where 

Lim V • (** •**) = 0 

m ^ m ,i,A 1 1,1 \ ^n,i,X / 

N i,x iex ' / 

The resultant mode dependent parameters required as input data to N-BOD2 are given by 
equations 48, 50, 51, 54, 55, 67, 70, and 72 in Reference 2. They are 

t 1 ~*T 

A , = — ) m. , v? . . 
n,X _ i,X n,i,X 

X ieX 

- D n,X = 2] n u[(° t i,X-°“x) • Vi,X 1 - Kx - °“x) V,i,x]. 

' ieX ' 


R - 1 V' o-> v ->-T 

B , - > m. , r. . X i p 

n,X i,X i,X n,i,X 


X ieX 


C = V ° 4 > -* R 

n,X £_j i,i,X ■ n,i,X 


ieX 


j . 

jt n »X 


V ^ R . X °<t>. . 

( r n,i,X i,i,X 


ie\ 


i . - , . i . * . . 

. IjV.i.X .?.n4A; i H,v,^w ? },X,^^xJ ff) M.XT2 


K 


m ,n ,X 


E ( ~*T v ~>T ^ 1 L, -+R \ v -*-R ) 

) i,X^m^,X ’n.i.X -j l i,i,X r m,i ,X / r n,i,X/ 
ieX ( L ' ' 
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If mode shapes are obtained by a continuum analysis, the rotational inertia effects of the 
infinitesimal elements about their respective centers of mass is negligible ; hence 


Lim C , = 0 


N. 


n,\ 


i,X 


lim J , = 0 


N. .-»•» 
i,X 


n,X 


and 


Lim K m X = ^2 m- ^ T ■ x x V T ■ 

N. — > oo m,n,\ / ^ i,X m,i,X r n,i,X 

•A ieX 


Lim 

N. . -►oo 
i,X 


[" y ' m. ip T tp T . - m. 5 1 = 0 

L ieX J 


The other mode-dependent parameters that are used or computed are: 
oj n — natural frequency of mode n of body X (rad/ . . . ) 

f n x - damping ratio for mode n of body X 

a n K (t) — generalized displacement coordinate for mode n of body X 

a n x (t) - generalized displacement coordinate rate for mode n of body X 

The position vector from the undeformed to the deformed center-of-mass position of the 
element i of body X is 


£ Vx<0^.,x 

n,X 

where the summation is overall modes defined for body X. 

The following parameters are defined in subroutine INOPT and used within the various sub- 
routines to compute the effects of body flexibility: 

NFLXB — total number of flexible bodies 

SFXM (I) — total number of flexible body modes to be used to describe the flexible 
body characteristics of body I (zero if body I is a rigid body or a point 
mass); 1=1,2,..., NBOD. 

SFLX — code word used to define the body labels of those bodies that are to be 
treated as flexible bodies. 

NMODS — total number of flexible body modes used for entire simulation model. 
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Upon recognition of the code word FLEXIBLE, the procedure for inputting uncoupled 
modal data starts. In columns 13 through 70 of the option card, 

, I = unused 

NSET = total number of bodies to be defined to be flexible. 

(SI (I), 1=1, NBOD) = the number of flexible body modes to be used to describe •: 

the flexible body characteristics of body I; I = 1 , 2, . . . , NBOD. 
(Zero if body I is a rigid body or point mass). .... , *. 

The parameters NFLXB, SFXM, SFLX, and NMODS are computed by an internal process 
that makes use of the above data provided on the option card. . . . . . 

To conserve computer storage and increase computation speed, all mode-dependent param- 
eters are sequentially numbered from 1 to NMODS by an internally defined algorithm that 
makes use of the SFXM integer array. All parameters associated with mode M of body K 
are given the integer label MN which is computed by the algorithm 

K-l 

, MN = M + SFXM(I) 

i=i •, 

where 

K = 2,3,. ...NBOD 

J .tq • 

and 

M = 1 ,2, . . ., SFXM(K) 

MN will be referred to as the “mode number.” 

All uncoupled mode-dependent data required by N-BOD2 are read immediately after recog- 
nition of the code word FLEXIBLE on an option card. For mode M of flexible body K, the 
following data must be defined. Its mode number MN is defined as 


MN = M + SFXM(I) 

1=1 . 

and recall that 

NFER = total number of free coordinate vectors. 

Then 

FLOM (MN) = cj m thfe modal natural frequency (rad/. . . ) 

ZETA (MN) . = f M k the modal damping ratio 
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THA (NFER + MN) = a M K (t) generalized displacement coordinate (initial value to be 

inputted) 


THAD (NFER + MN) 
{FLA (I, MN)} 

|FLB (I, MN)[ : i 
{FLC (I, MN)[ 

[FED (I, J, MN)] 
[FLJ (I, J, MN)] 


= a w „ (t) the generalized displacement coordinate rate (initial value 

M , K. " 

to be inputted) - 

— y 

- components of the resultant mode-dependent vector A^ K relative 
i .'to the body K fixed reference frame. 

- | •• ■ y l **V • * . — ^ 

= components of the resultant mode-dependent vector B M K relative 
/ to the-body K fixed reference frame. ^ , . < 

= components of the resultant mode-dependent vector C M ‘ K relative 
to the body K fixed reference frame. , , 

= components of the resultant mode-dependent dyad D M K relative 

to the body K fixed reference frame. ’ 1 

. • • h 

= components of the resultant mode-dependent dyad J M K relative 
to the body K fixed reference frame. 


The data required to describe the uncoupled modal data for each flexible body are read ac- 
cording to the following sequence of read statements. 


************ READ STATEMENTS FOR OPTION •FLEXIBLE* IN 1N0PT 

f. 

o initialize mode labels 
MN = o 
C 

#*»***#**«** RE40 UNCOUPLED MODE DATA FDR ALL FLEXIBLE BODIES ********** 

00 1 K=1,NB0D 

IFISFXM(K).EQ.O) GO TO 1 BODY K IS NOT A FLEXIBLE BODY. 

BEAD 103, N, (MESS (■)>•■ 1=1, IB) 

; IF(K.NF.N) ERROR. CARDS CJUT OF SEQUENCE, .PRINT MESSAGE HALT 

C N = ROOY label FOR' WHICH FLEXIBLE BODY 'DATA TO FOLLOW APPLIES 

C: : . . MESS = ALPHANUMERIC (DESCRIPTION' OF BODY N, PRINTED WITH DATA ECHO.. 

c 

************ READ E X ACT Y SFXM(K) SETS OF MODAL DAtA FOR BODY K ********* 

DO ? M =1,SFXM(K> 

MN = MN + 1 

READ 1 0 A , FLOM(MN) . ZETAIMN ) 

READ 104, THA ( NFER + MN ) , THAD( NFER+.MN ) 

.READ 104 , ( F L A ( I . MN >,1 = 1,3)- ' . 

Read 104 , ( flri i ,mn ) , 1 = 1 ,3V 

READ 104, { FLC ( I,MN> ,1 = 1,3) 

■' .READ 104, ( ( FLDI I , J,MN ) , J=1 ,3) , 1 = 1 , 3 ) 

R FAD 104, ( ( FL J( I ,.I,MN) , J=1 ,3) , I = 1 ,3 ) 

? CONTINUE 

************ flLL UNCOUPLED MODAL DATA FDR BODY K HAS HFEN READ *********' 

C 

C . ' , 

1 CONTINUE 
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s***.*::?**:**** ALL UNCOUPLED MODAL DATA has KEEN head 

C 

C 

********$*** END OF DATA FOR OPTION 'FLEXIBLE ssss^sststissss s=sss=s 

C 

C 

C FORMAT STATEMENTS 

103 FORMAT (15,1 H A4 ) 

104 FORMAT (3D15.5) 


The input of the coupled modal data follows the option card ‘MODE CUP.’ . . 

In the process of developing the equations that define centripital and Coriolis related loads 
associated with flexible bodies, certain mode-dependent, cross-coupling parameters are de- 
rived; namely F m x and K m n x (previously defined in this section). In many practical ap- 
plications, most, if not all, of these terms are identically or nearly equal to zero. Computer 
time and storage can be conserved by developing a scheme which will only use nontrivial 
cross-coupling terms. 

The following parameters are defined in subroutine INOPT and used in subroutine QFDOT 
to compute the modal cross-coupling effects. 

SFCC = code word. Used to define the body labels of the flexible bodies that 

have flexible body modes that are cross coupled (significantly). 

SCXC (MN) = code word. Used to define the modes M of body K which significantly 
cross couple in the generalized displacement coordinate equation for 
the mode having mode number MN 

K-l ' « 

MN = N + SFXM(I) 

i=i 

From equation 95 of Reference 2, the cross-coupling terms in the equation for the generalized 
displacement coordinate associated with mode n of body X are 


cu. 


) h " F m,nA W® I 

L m,X J 


CD, 


-' 2u r‘ 


E 




(t)’K; 


m,n,X 


More simply expressed, the SCXC array'defines which mOdesTfi of body X shall be used in 
evaluating the above summations. 

In the input deck, the code word MODE CUP must follow FLEXIBLE. Upon recognition 
of the code word MODE CUP, the procedure for inputting coupled modal data starts. In 
columns 13 through 70 of the option card. 


I = unused 


NSET = unused 
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(SI (I), 1=1, NBOD) = number of blocks of mode dependent cross coupling data to be 

read in for body I; a block of data consists of the three integers 
(M, N, K), the components of the tensor F M N K , and the compo- 
nents of the vector N K 

The parameter SFCC is computed by an internal process which makes use of the above data 
provided on the option card. 

To conserve computer storage and increase computational speed, all coupled mode-dependent 
data are sequentially numbered. Strict adherence to the following input logic is required. 

MN = 0 • 

KF = 0 

DO 1 K =1 , NBOD %. 

■DO 1 N =1, SFXM(K) 

MN = MN+1 

DO 1 M = 1 , SFXM(K) 

IF [F MNK INSIGNIFICANT .AND. K m n k INSIGNIFICANT] GO TO 1 
READ M, N, K 
KF = KF+1 

READF M,N,K and '<M > N,K 

LOAD F m n k into FCF array^startirig at location (1,1 ,KF) 

LOAD 1< M N K into FCK array, starting at location (1 ,KF) 

ADD integer M to code word SCXC(MN) 

1 CONTINUE 

where 

MN — mode number for mode N of body K 

KF — storage location integer designator for modal cross-coupling parameters 

[FCF(II JJ,KE“)]r^ components of the resultant coupled mode-dependent tensor 
F m n k relative to the body K fixed reference frame (if M = N, 

nr tog u ad Hr* , fh .^s^ifipan^^ usually .exist), , , 4 ...... , ;hru! , 

[FCK(II,KF)] — components of the resultant coupled mode dependent vector 
, K M N K relative to the body K fixed reference frame. 


I 

] 
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All coupled mode-dependent data required by N-BOD2 are read immediate'ly after recogni- 
tion of the code word MODE CUP on an option card. If flexible bodies are defined and the 
‘MODE CUP’ option card and associated data are not in the option deck', all computation 
required to define modal cross-coupling effects is skipped. • ! 

The data required to describe the coupled modal data for each flexible body are read accord 
ing to the following sequence of read statements: • ■ ‘ 

i * . * ■ i 

’ ' 8 READ STATEMENTS FOR OPTION 'MODE CUP' IN INOPT 

c : ' 

C . INITIALIZE COUPLED MODE LABELS . , . - , 

KF = 0 

C 

^‘READ ALL NON TRIVIAL COUPLED MODE PARAMETERS 

. C - • . • • • ' ' 

DO 1 K = 1, NBOD . .. 

C 

C SI (K) = NUMBER OF DATA.BLOCKS FOR BODY K . 

C SFXM(K) = NUMBER OF MODES USED FOR BODY K 

IF(SFXM(K).EQ.O) GO TO 1 (BODY K IS RIGID) . .. 

IF(SI(K).NE.O.) GO TO 2 (SOME CROSS COUPLING FOR BODY K) 

GOTO 1 

2 DO 1 M = 1 , SI (K) nil. ' 

READ 105 MB, NB, KB 

KF = KF + 1 ' 

READ 104, (FCF(IUJ,KF),JJ = 1,3), II = 1,3) 

READ 104, (FCK(II,KF),II = 1,3) 

1 CONTINUE 
C 

* ALL COUPLED MODAL DATE IN 

C • ' ' 

C 

C FORMAT STATEMENTS : 

104 FORMAT (3E 15.5),... , .’-I; 

105 FORMAT (315) 

Default Unless otherwise directed, -the simulation modehwill consist only of rigid bodies, 
point masses, and symmetric wheels. All parameters associated with flexible bodies.will be 
set equal to zero. 

PROGRAMMER'S GUIDE TO SUBROUTINE INOPT 

The main function of subroutine INOPT is to accept the data that will define the parameters 
associated with the various computational options available to the user. It is structured to 
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grow. As new modeling requirements are defined and their associated equations developed, 
.INOPT is the subroutine in which the basic data required to define the new option are to be 
entered. This is done by simply defining another code word that will be re^gnized along 
with the FORTRAN coding required to set up the basic data necessary to djescribe the new 
option. 

Subroutine INOPT has the following structure: 

• Define by default all parameters associated with available options. 

• Read option card and compare option code with library of recognizable codes. 

• Branch to appropriate program point, redefine option-related parameters, input 
any additional data required. 

• Branch back to program point 12 to read another option card. 

• Upon recognition of the ‘END OPTIONS’ code word, check all option data for 
basic incompatabilities. 

• Perform any final setup work that must be done after all option data have been 

inputted. _ . ; . 

• Print an echo of all option related data defined in INOPT. 

The following variables, defined in table 1, are either first introduced or used extensively in 
subroutine INOPT. The programmer is referred to the comment cards inserted therein, and 
the following, for detailed definition. 

CT1 — counter. Zeroed before exit from INOPT 

CT2 — counter. Zeroed before exit from INOPT 

CT3 — counter. Zeroed before exit from INOPT 

CT4 — counter. Zeroed before exit from INOPT (See DYN) 

CT5 — counter. Zeroed before exit from INOPT 

[FCF(I J,K)] - See section “Data Input/INOPT,” subsection 15 

|FCK(I,K)| — See section “Data Input/INOPT,” subsection 15 

FG3 — input error flag. If the code word on any option card is not 

t - recognized, it is set to .FALSE. 

|FLA(I,MN)} - See section “Data Input/INOPT,” subsection 1 5 

|FLB(I,MN)} — See section “Data Input/INOPT,” subsection 15 

|FLC(I,MN)} - See section “Data Input/INOPT,” subsection 15 

[FLD(I,J,MN)] — . . See section “Data Input/INOPT,” subsection 15 


53 



[FLJ(I,J,MN)] — See section “Data Input/INOPT,” subsection 1 5 

FLOM(MN) — See section “Data Input/INOPT,” subsection 15 

INERF 1 - See section “Data Input/INOPT,” subsection 3 

NCTC — See section “Data Input/INOPT,” subsection 12 

NFKC — See section “Data Input/INOPT,” subsection 12 

NFLXB — See section “Data Input/INOPT,” subsection 15 

NFRC — See section “Data Input/INOPT,” subsection 10 

NMOA — See section “Data Input/INOPT,” subsection 1 1 

NMODS See section “Data Input/INOPT,” subsection 15 

NMV — See section “Data Input/INOPT,” subsection 13 

SC(I) — See section “Data Input/INOPT,” subsection 14 

SCXC(K) — See section “Data Input/INOPT,” subsection 1 5 

SCG — See section “Data Input/INOPT,” subsection 14 

SCN(I) — See section “Data Input/INOPT,” subsection 6 

SCR(I) — See section “Data Input/INOPT,” subsection 6 

SD - See section “Data Input/INOPT, ’’tiibsection 7 

SEU - See section “Data Input/INOPT,” subsection 7 

SFCC — See section “Data Input/INOPT,” subsection 15 

SFK(I) — See section “Data Input/INOPT,” subsection 1 2 

SFLX — See section “Data Input/INOPT,” subsection 15 

SFR(I) — See section “Data Input/INOPT,” subsection 10 

SFXM(I) — See section “Data Input/INOPT,” subsection 1 5 

SIX(I) — See section “Data Input/INOPT,” subsection 5 

SLK(I) — See section “Data Input/INOPT,” subsection 1 2 

SMA(I) — See section “Data Input/INOPT,” subsection 1 1 

SMAL — See section “Data Input/INOPT,” subsection 7 

SMC(K) ' — code word. Used to define the symmetric wheel labels 

associated with all wheels contained in the nest K-l ; 
K= 1,2,... ,-NBOD 

SMV , — See section “Data Input/INOPT,” subsection 13 
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SPI(I) — . See section “Data Input/INOPT,” subsection 4 

SVD - See section “Data Input/INOPT,” subsection 8 

SXM(I,K) — computed integer array. Used in subroutine TRAN if the trans- 

formation matrices for body K are to be computed using Euler- 
angle techniques. SXM(I,K) defines the coordinate axis (±1 , ±2, 
±3) in body K along which the free coordinate vector M+(I-1), 
1=1,..., 3-PCON(K), is aligned in the zero state (sign implies 
direction). ' It is computed only if needed; otherwise it is set to 
zero. 

SXT — See section “Data Input/INOPT,” subsection 9 

TUG(I) — See section “Data Input/INOPT,” subsection 14 

ZETA(MN) — See section “Data Input/INOPT,” subsection 1 5 

DATA INPUT, SUBROUTINE INTOR 

The third and last input data subroutine to be entered is INTOR. Normally this routine 
contains no executable instruction. It is for the user. The user may insert any desired input 
statements and store the resultant data in common block /SATELL/. The data inputted 
here usually consist of all data needed to define the parameters in the user-defined description 
of the forces and torques acting on the simulation model. 

There are no new variables introduced in this subroutine other than those that are user defined. 

PROGRAMMER'S GUIDE TO SUBROUTINE TRNSIV 

The primary purpose of the computation coded in subroutine TRNSIV is to compute initial 
values for all required transformation matrices. The user need never interface with this sub- 
routine. 

All required computation carried out in N-BOD2 is done relative to the frame of computation 
(see section “Data Input/INOPT,” subsection 3). Consequently, transformation matrices which 
take vectors from body fixed coordinates to computing frame coordinates must be evaluated. 
TRNSIV computes the initial values of these matrices based upon the data inputted in sub- 
routine INBS. Quarternion techniques are applied since gimbal axes need not be aligned with 
body fixed coordinate axes (see Reference 1, section “Initial Orientation of the N-Body 
System” and Appendix “Quarternion Techniques”). 

The following variables, defined in table 1 , are first introduced in subroutine TRNSIV. All 
other variables used therein have been previously defined. The programmer is referred to 
the comment cards inserted in TRNSIV, and the following, for detailed definitions: 

[XMC(I,J,K)1 

for K = 0 — transformation matrix used to transform vectors from . 

inertially fixed coordinates to the frame of computation. 
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for K = 1 , 2, . . . , NBOD — transformation matrix used to transform vectors 

from body K fixed coordinates to the frame of com- 
putation,. 

where 

" XMC (1,1 ,K) XMC (1 ,2,K) XMC(1,3,K)" 

[XMC(U,K)] = XMC (2,1,K) XMC (2,2, K) XMC (2,3, K) 

_ XMC (3,1,K) XMC (3,2,K) XMC(3,3,K)_ 

For any particular problem, all computation carried out in TRNSIV can be outputted on 
the line printer by defining 

LTRNSI = .TRUE. 

on card 1 of the data deck. There is a one-for-one correspondence between the line printer 
output and the theoretical notation in Reference 1 . 


PROGRAMMER'S GUIDE TO SUBROUTINE VDIV 

The initial values for all body fixed vectors and tensors, relative to the frame of computation, 
are computed in subroutine VDIV. The user need never interface with this subroutine. 

All vector-tensor operations required to define the system equations of motion are carried 
out in computing frame coordinates. N-BOD2 attempts to avoid redundant and trivial com- 
putation by transforming all body fixed vectors and tensors, used more than once, into 
computing frame coordinates at time zero. Thereafter, integer sets, computed in VDIV, are 
used to transform, at every integration step, only those vectors and tensors that have non- 
trivial time-varying components relative to computing frame coordinates. 

The following variables, defined in table 1, are first introduced in subroutine VDIV. All 
other variables used therein have been previously defined . The programmer is referred to 
the comment cards inserted in VDIV, and the following, for detailed definitions: 

v 

components of the vector from hinge point K-l to 
the deformed center-of-mass position of body K, re- 
lative to the frame of computation (see Reference 2, 
equation 47). 

components of the vector from hinge point K-l to 
the undeformed center-of-mass position of body K, 
relative to body-K fixed coordinates. 

unused. Reserved for the components of the vector 
from the inertial origin to the composite system 
center-of-mass, if needed. 


|CAC(I,K)f 

for K= 1, 2, . . . , NBOD 


|CAO(I,K)} 

for K= 1,2, . . . , NBOD 

|CBC(I,K)} 
for K = 0 
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for' K = 1 ; 2, ■ . 


|FLAC<I,MN)| 


[FLE(I,J,MN)] 


[FLH(I,J,MN)] 


|FLQ(I,MN)} 


|FLQC(I,MN)| 


: . , NBOD — components of the vector from hinge point 

JCON(K)-l to hinge point K-l, relative to the frame 
of computation (N-BOD2 assumes zero elastic de- 
formation at hinge points). 

— components of the mode-dependent vector defined by 
equation 48 of Reference 2 relative to the frame of 
computation. It is used in equation 47 to define the 
contribution of mode M deformation of body K to 
the vector which defines the deformed center-of-mass 
location of body K, where mode number MN is de- 
fined as 

K-J 

MN = M + ^ SFXM(I) 

l=i • 

K = 2,3,. .., NBOD 
M = 1,2,... ,SFXM(K) 


— components of the mode-dependent tensor defined 
by equation 52 of Reference 2 relative to body K 
fixed coordinates. It is used in equation 49 to define, 
the contribution of mode M deformation of body K 

i. • . ' 

to the deformed state inertia tensor of body K, where 
MN is the mode number defined as above. 

— components of the mode-dependent tensor defined by 
equation 68 of Reference 2 relative to body K fixed 
coordinates. It is used in equation 65 of Reference 2 
to define a component of the generalized force acting 
on mode M of body K, where MN is the mode number 
defined as above. 

— components of the mode-dependent vector defined by 
. equation 56 of Reference 2 relative to the body K 

fixed reference. It is used in equation 53 of Reference 
2 to compute the contribution of mode M deformation 
rate to the angular momentum of body K, where MN 
is the mode number as defined above. 

— components of the mode-dependent vector defined by 
equation 56 of Reference 2 relative to the computing 
frame. 
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:|GAM(I,KL)} 

for M = 1, 2, . . . , MNO 
NS VP 
NSVQ 
|QFC(I,M)} 

for M = 1 , 2, . . . , NFER 
{QLC(I,L)} 

for L= 1, 2, .. . ,NLOR 
SOK(K) 

for K = 1, 2, . . . , NBOD 

SOK(NBI) 

for NBI = NBOD+1 

SSCN 
SSIX - 
SVA 
SVB 
SVI 


— unused in VDIV; however, all elements of the array 
GAM are set equal to zero in VDIV. r 

— components of the unit vector directed along the 
spin axis of symmetric wheel M relative to the frame 
of computation (N-BOD2 assumes zero elastic defor- 
mation at wheel attachment points). 

— total number of locked coordinate vectors to be 
transformed to computing frame coordinates at every 
integration step. 

— total number of free coordinate vectors to be trans- 
formed to computing frame coordinates at every 
integration step. 

— components of free coordinate vector M relative to 
the frame of computation. 

— components of locked coordinate vector L relative 
to the frame of computation. 

— code word used to define the body labels of those 
bodies on the topological path from hinge point 0 to 
the center-of-mass of body K. 

— code word used to define the set of integers from 1 
to NBOD+1 inclusive. 

— code word used to define the union of all labels con- 
tained in the sets of integers defined by the code 
words SCN(K); K = 0, 1 ,..., NBOD-1. 

— code word used to define the union of all labels con- 
tained in the sets of integers defined by the code 
words SIX(K); K = 0, 1, . . . , NBOD-1 . 

— code word used to define the set of center-of-mass 
vectors that have nontrivial time-varying components 
in the frame of computation. 

— code word used 'to 'define the set of hinge-point vectors 
that have nontrivial time-varying components in the 
frame of computation. 

— code word used to define the set of inertia tensors 
that have nontrivial time-varying components in the 
frame of computation. 



— code word used to define the set of symmetric-wheel 
spin vectors that have nontrivial time-varying compo- 
nents in the frame of computation. 

— the labels associated with the locked coordinate vectors 
that must be transformed at every integration step. 

— the labels associated with the free coordinate vectors 
that must be transformed at every integration step. 

— unused in VDIV; however, all elements of the array 
XDIC are set equal to zero in VDIV. 

— components of the inertia tensor of body K about its 
center -of-mass in the deformed state relative to the 
frame of computation (see Reference 2, equation 49). 

— components of the inertia tensor of body K about its 
undeformed center-of-mass position in the undeformed 
state relative to the body K fixed reference. 

For any particular problem, all computation carried out in VDIV can be outputted on the 
line printer by defining 

LVDIV = .TRUE. 

on card 1 of the data deck. 

PROGRAMMER'S GUIDE TO SUBROUTINE EQIV 

The complete description of the motion of the coupled-body system is defined by the simul- 
taneous solution of a set of first-order, nonlinear, ordinary differential equations. Subroutine 
EQIV is used to compute the total number of first-order equations to be integrated (excluding 
those that are user defined) and to set up an array of initial conditions in a form compatible 
with the integration subroutine RUNGE. The user need never interface with this subroutine. 

The following variables, defined in table 1, are first introduced in subroutine EQIV. All other 
variables used therein have been previously defined. The programmer is referred to the com- 
ment cards inserted in EQIV, and the following, for detailed definitions: 

NEQ — total number of first-order differential equations that 

will be set up and numerically integrated via RUNGE 
(excluding those that are user defined in TORQUE). 

In the coding of the equations of motion, the system state variables and their associated time 
derivatives are stored in various arrays which are given different symbolic names. 


SVM 


SVP(L) 

for L = 1,2, ...,NSVP 
SVQ(M) 

for M = 1, 2, . . . , NSVQ 
tXDIC(U,IK)] 


[XIC(I,J,K>] 
for K = 1 , 2, . . . , NBOD 


[XIO(I,J,K)l 

for K = 1,2, ..., NBOD 
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To effectively use the integration subroutine, these must all be reloaded into two one- , 
dimensional arrays so that the equations to be integrated take on the general form 

[^i (^)>'- • •> y N gQ (t)> yj (t), . . y NE Q (t), tj 

where 

N = 1,2,. . ., NEQ. .... , . 

Y(N) : * — one dimensional array in which all state variables 

. , •••.•. • that are determined by integration are stored for 

entry dnto the integration package. In EQIV, all 
initial values are defined 

N = 1,2, . . . , NEQ. 

The following sequential ordering scheme is used to define the location of each system state 
variable in the array Y. 

■ • Angular and linear rates about or along all of the free-coordinate vectors 

THAD(N); N = T, 2, . . . , NFER 

• Generalized elastic coordinate rates for all modes of vibration 

THAD(N); N . = NFER + 1 , . . . , NFER + NMODS. 

• ■ Angular rates for all variable-speed , wheels ■ 

THADW(M); M defined by code word SMV. 

• Displacements about or along selected free-coordinate vectors 

THA(SFR(N)); N = 1, 2, . . . , NFRC. . 

• Generalized elastic coordinates, all of them 

THA(N); N = NFER + 1, ..., NFER + NMODS. 

• Angular position of selected wheels 

THAW(SMA(M»; M = 1,2,..., NMOA. 

ot # h ft f i Elerfieiits- of 1 the first ^ r fwb ( columns of 'each- transformation matrix that-is obtained 
by direction-cosine technique 

XMC(I,J,M); 1 = 1,2,3 

... J>. 1,2 

M defined by code word SD. 


60 



Refer to subroutine listing for exact details if needed. For any particular problem, all com- 
putation carried out in EQIV can be outputted on the line printer by defining 

A LEQIV = .TRUE. 

on card 1 of the data deck. 

PROGRAMMER'S GUIDE TO SUBROUTINE TRAN 

Numerical solution of the vector-dyadic equations of motion requires that the orientation 
of all body fixed-reference frames relative to each other and to the inertially fixed frame be 
obtainable.' A minimal set of transformation matrices is the set that defines the relative 
orientation of each body fixed and inertially fixed reference frame to the frame of compu- 
tation. These transformation matrices are evaluated in subroutine TRAN. The user need 
never interface with this subroutine. 

As discussed in section “Data Input Subroutine INOPT,” subsection 7, three kinematic, 
methods for obtaining transformation matrices are available for the user. TRAN makes use 
of the data stored in the code words SD, SMAL, and SEU to determine the kinematic tech- 
nique to be used for the computation of each respective transformation matrix. 

The following variable, defined in table 1, is recomputed in subroutine TRAN. All other 
variables used have been previously defined. The programmer is referred to the comment 
cards inserted in TRAN, and the following; for detailed definitions: 

[XMC(I,J,K)] — see section “Programmer’s Guide to Subroutine TRNSIV.” 

In subroutine TRAN, which is entered four times per integra- 
tion step, the elements of all transformation matrices that have 
> • time-varying coefficients are recomputed. 

If direction-cosine techniques are used, the first two columns of the transformation matrix 
[XMC(I,J,K)] , namely . 

{XMC(l,l,K)f and |XMC(I,2,K)} 

are computed by integration of direction-cosine rate equations. The third column 

|XMC(I,3,K)j ... . 

i&$&ffl£>.¥.t?,0 jT^N~by,,& simple vector. cross-product-operation. ~Norattem.pt ds-mad© to 
ensure that the resultant matrix is orthonormal. 

The author is of the opinion that since it generally is impossible to determine which of the 
six integrated direction cosine parameters is contributing most strongly to any error buildup, 
it is also impossible to define an orthonormalization procedure which would be satisfactory 
for all possible situations. If orthonormalization of transformation matrices must be main- 
tained to a high degree of accuracy, then Euler angle techniques should be called for in 
INOPT. 


i 
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If Euler angles are used, the appropriate free coordinate vectors must be aligned with body 
fixed coordinate axes in the nominal zero displacement state. Euler angle techniques are 
used to obtain only the transformation matrix between pairs of contiguous bodies. The trans- 
formation matrix to the computing frame is obtained by an appropriate matrix multiplication. 
The same logic is used for the small-angle technique with the exception that the approximation 

y = sin (? M : , 

is employed. 

For any particular problem, all computation carried out in TRAN can be outputted on the 
line printer by defining !•' 

LTRAN = .TRUE. 

on card 1 of the data deck. 

PROGRAMMER'S GUIDE TO SUBROUTINE TRANVD 

The primary purpose of TRANVD is to transform to computing frame coordinates all body 
fixed vectors and tensors, which are used more than once in the evaluation of the equations 
of motion. The user need never interface with this subroutine. 

The following variables defined in table 1 are recomputed each time TRANVD is called by 
DYN: 

}CAC(I,K)| ,|HMC(1,M)| 

|CBC (I,K)| |QFC(I,M)} 

|flac(i,mn)| |qlc(i,l)| 

|FLQC(I,MN)} [XIC(I,J,K>] 

Each of the above variables is defined in the section “Programmers Guide to Subroutine VDIV.” 
In subroutine TRANVD, which is entered four times per integration step, the transformation 
matrices evaluated in TRAN are used to obtain the components of each of the above body 
fixed vectors and tensors in computing frame coordinates. Only those that have time-varying 
components in the computing frame are recomputed; all others retain the initial value that was 
set in VfDlV.bsnistnoj rtoi- t-' \h'A r.Ht 1 m'-f* wrvm'VYvy. - M o oi .-nnanoqrnoy arl i 

For any particular problem, all computation carried out in TRANVD can be outputted on the 
line printer by defining 

LTRANV = .TRUE. ' 

on card 1 of the data deck. 


62 


PROGRAMMER'S GUIDE TO SUBROUTINE RATE 

The primary purpose of subroutine RATEis to compute all linear and angular velocity vectors 
that will be required by the succeeding subroutines. The user need never interface with this 
subroutine. 

In the coding of N-BOD2, all hinge points of the system are assumed to be either on rigid 
bodies or at node points of flexible bodies. Consequently, all rate-related effects associated 
with the deformation dependent motion of hinge points are identically equal to zero. That is, 
in Reference 2, equation 126, all elements of the partition , and ^ equal zero. 

The following variables are defined in table 1 and recomputed each time .subroutine RATE 
is called by D YN : - 

jROMC (I,K)f {COMC(I.K)} 

{FOMC(I,K)[ |DOMC(I,K)} 

In Reference 1 , equation 141 , the partition that defines relative rate between contiguous 
bodies is ' ’ • : ' ' • : • • : 

{w} - 


In Reference 2, equation 126, it is 


K R JM 


where, by equation 133, Reference 2, 


{°w| = |qj . 


and under the restrictions of N-BOD2 


tv;,' .* v .* 


.i j .. ; ,j^L . l°J ,. 


The components, relative to the computing frame, of the NB1 vectors contained in* the ni t«*? 
column matrix j oo f are stored in the array ROMC according to the following storage conven- 
tion: 

• Body K is a rigid or flexible body; K = 1 , 2, . . . , NBOD 

i 

|ROMC(I.K)[ = | 5 j = £ *mKm( 

M @ K-l c 
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• Body K is a point mass; K = 2, 3, . . . , NBOD 

iKOMCdK,} Km! 

C M@K-1 c 

• K = NB1 implies linear velocity of the center-of-mass of body 1 relative to inertial 
origin 

|rOMC(I3C)H{^1 = 12 Km} 

c M@K-1 C 


Note that by applying equation 134 of Reference 1 , namely 

W K = 12 

M@K-1 

all trivial multiplications by zero called for by the matrix equation 

|£i = |qJl 5 ! 

are circumvented. 

The relative angular-rate vectors stored in the array ROMC are used to compute the inertial 
angular-rate vectors; the components of which, relative to the computing frame, are stored 
in the array FOMC. Making use of equation 37 of Reference 1 , the following parameters 
are stored in the array FOMC: 

• Body K is a rigid or flexible body; K = 1 , 2, . . . , NBOD 

{F0MC(I,K)| = {£ k | = J2 m 

c c 


• Body K is a point mass, since hinge point K-l is at a node point on body 
JCON(K); K = 2, 3, . .. , NBOD 

| FOMC (I,K)} =B (K )} c 

• K = NB1 


| FOMC (I,K)| = { ROMC (1 ,K) f 


The elements of this array. FOMC are used primarily to compute gyroscopic cross-coupling 
loads. 
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The user may choose the frame of computation to be either the inertially fixed-reference 
frame or the body 1 fixed-reference frame. In Reference 1 , pages 34 and 35, the angular 
rate of the body K fixed-reference relative to the computing frame is defined. The compo- 
nents of these vectors, relative to the computing frame, are stored in the array COMC; that 
is, 

• Body K is a rigid or flexible body; K = 1 , 2, . . . , NBOD 

{comc a»H A 1, 

• Body K is a point mass; K = 2, 3, . . . , NBOD 

ICOMCOJO]-- j 3 I(K) | t 

• K = NB1 

| COMC (I,K) [ = jROMC (I,K)| 


The elements of this array COMC are used primarily in the evaluation of the direction cosine 
equations to be integrated. 

In Reference 1 , equation 136, differentiation of the relative angular-velocity vector yields 

mi- . ■ " ■ ■ ■ - ' ■ 

w k " Pm q M + 

M@K-1 

The second term reflects the fact that free-coordinate vectors are not inertially fixed. This 
term carries through the development and appears in the final partitioned matrix form of the 
equations of motion: Reference 1 , equation 144; or Reference 2, equation 1 36; as 

uj Pi 

The elements of the column matrix are computed and stored in the array DOMC according 

to the following storage convention: , 

-r • ><••••*• ■J'-U 

• Body K is a rigid or flexible body; K = 1 , 2, . . . , NBOD 

{DOMC(IJC)} = ^ I’m1 c 

M @ K-l 

• Body K is a point mass K = 2, 3, . . /* NBOD or K = NB1 ; 

{DOMC(IJC)} = jo} 
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The components of the vectors q M are needed only for the above computation and are not 
stored in COMMON; furthermore, only those having nonzero components are evaluated. 

For any particular problem, all computation carried out in RATE can be outputted on the 
line printer by defining 

LRATE = .TRUE. 

on card 1 of the data deck. 

In the coding of subroutine RATE, it should be rioted that by use of the EQUIVALENCE . 
statement the single subscript arrays EFOMC, EROMC, ECOMC, and EDOMC, are used inter- 
changeably with the double subscript arrays FOMC* ROMC, COMC, and DOMC, respectively. 
This is done to optimize computation speed. 

PROGRAMMER'S GUIDE TO SUBROUTINE XDY 

The primary purpose of subroutine XDY is to compute all required hinge point to center-of- 
mass position vectors and all inertia and pseudo-inertia tensors. The user need never interface 
with this subroutine. 

On the left-hand side of the system equations of motion given in Reference 1 by equation 144 
and in Reference 2 by equation 136, the computation of numerous pseudo-inertia tensors is 
required. To compute these tensors, it is also required to compute the components of the 
position vectors which locate center-of-mass position relative to hinge points. 

In TRANVD, the center-of-mass vector, hinge-point vector, and inertia tensor for each body 
of the system is computed. Once these vectors and tensors are determined, no distinction 
need be made between rigid and flexible bodies for the computation of inertia and pseudo- 
inertia tensors of nests of bodies. Consequently, equations 1 1 and 63 through 70 of Reference 
1 may be applied to define the contents of the matrix of inertia tensors defined by the parti- 
tion 


[X] 

in the equations of motion. 

The following variables are defined in table 1 and computed in XDY : 


| GAM (I JCL)} 
[XDIC (1 3 XI)] 


! * h y 


t 


In Reference 
the equation 


, equation 1 1 , hinge point to center-of-mass position vectors are defined by 


7 K -i,l 


E 

ieS K-l,L-> 

i*K 
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where 


K = 1,2,.. . , NBOD 
K < L 


and 


To conserve computer storage and eliminate a superfluous dimension, the integer function 
KTO, defined along with the other utility subroutines, is used to store the triangular matrix 
of vectors in a two-dimensional array. That is ,• 


where 


)GAM(1,KX,)[ = )r K . 1>L r 


KL = KTO (NB1, K-l, L) 


In Reference 1 ^equations 63 through 70, the tensor in row K, column I, I > K, is defined by 
the equation that satisfies one of the following criteria: 


1. KeS R , IeS K _i, IeS R 


K ,1 


E ♦ E 

XeS I-l XeSj.j 


2. KeS R , IeS K .,, r IeS L 


3- KeS R , US^ 


^ S M 


X K,i 


K-l ,1-1 


, . .. i.- . - Oil,:, j., 




4. KeS L , I = K 


x k,i = m i 1 
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5. KeS L> WS K , 


6. K e S R , I = NB1 


7. K e S L , I = NB1 


X k,, = 0 


X K,I. ~ ' ^ m X r K-l,X 


X K,I = m K 1 


8. K = NB1, 1 = NB1 




where 


g k-i,m m x 


,x ’ 7 k-i,x) 1 " ^ i-i ,x k-i , xj 


^K-1,X ^K-l,X^ 


1 = unit dyad 


To conserve computer storage and eliminate a superfluous dimension, the integer function 
KT1, defined along with the other utility subroutines, is used to store the symmetric matrix 
of tensors in a three-dimensional array. That is '• * 


: - [XDIC (I, J, KI )],.= , [x k 1 

vtrrn • L ’J c 


v; i 1 Ji 1 1 \ ' 


KI = KT1 (NB1,K,1) 
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From symmetry 


[x, K ] c = [XDIC (I, J, KI)] T 
where post superscript T implies “transpose.” 

On the first pass through XDY, all elements of the arrays XDIC and GAM are computed. 
Thereafter, only those elements of the arrays that have time-varying components are re- 
computed. To do this, the integer arrays, defined by the code words SPI, SVD, and SXT, 
are used. 

For any particular problem, all computation carried out in XDY can be outputted on the 
line printer by defining 

LXDY = .TRUE. 

on card 1 of the data deck. 


PROGRAMMER'S GUIDE TO SUBROUTINE ETA 


The primary purpose of subroutine ETA is to compute the forces and torques associated 
with the gyroscopic motion of each body and each nest of coupled bodies. The user need 
never interface with this subroutine. , 

On the right-hand side of equation 1 12 of Reference 2, the matrix 


W 


contains all gyroscopic forces and torques that enter into the coupled body equations of 
motion. The vector elements of this matrix are defined by the terms appearing in equations 
107 and 108 of Reference 2. For the case of coupled rigid bodies, these terms reduce to 
those defined in Reference 1 by the partitions 


j*? c [ and jr? 1 ! 

of equation 88. • ; '■ ■■ 

Subroutine ETA is programmed to avoid redundant and' trivial computations. The integer 




code words SCN, SCR, SIX, SMC, SFLX, SFXM, SSCN, and SSIX are used to pick out 
exactly which bodies contribute significantly in each step of the computation. Only non- 
zero time-varying contributions are computed. 


The following variables are defined in table 1 and computed in ETA: 


|ETIC(I,K)} {FLCRC(I,K)[ 

|CNF(I,K)| |ETMC(1,M)| 

|flirc(i,k>| |etc(i,k)} 
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The gyroscopic torque acting on the nest K-l, which consists of at leasLone rigid body, is 
from Reference 2, equation 107 

" Z U x • w x + w x >^,L x x + 7 K . 1A X C X ] 

X£S k-i 

where 


->■ 

L 


x,x 


= <f> • + AL 


x,x 


H. 


M: 

MO(M)=X 


AL 


x,x 


2 

N,X 




= Z E N,X 4 NA (t) 


N,X 


C X = m x 


[E (' 

*- leS 0,X-l 
i * 1 


+ A X (“x X "x> + 2 “x X 

o 

(In N-BOD2 all ^ assumed zero) 




The gyroscopic force acting on the nest L-l , which consists of the point mass defined as body 
L, is from Reference 2, equation 108 



and from the same equation, the gyroscopic force acting on the composite system is 

ri ; « // b0> nc'F.fc Tt*i . <■' ■r-t,or, vbod b - o»q«.Ot.oriQ$ bit A .f 

AeS 0 ' ■ • , ...... 

These resultant quantities are computed and stored in the array ETC, so that 

|eTC( 1,K)1 = components of the gyroscopic load vector, in computing frame 

coordinates, acting on the nest K-l ; K = 1 , 2, . . NBOD. 


/ETC(I,NBI)v = components of the gyroscopic force vector, in computing frame 
' ' coordinates, acting on the composite system. 

The following procedure is used to compute the elements of the array ETC: 

1. For all bodies L contained in the set defined by the code word SSIX, compute 

|etic (i,l) [ = |£ l x(<Vw l )| c 

2. For all bodies L contained in the set defined by the code word SSCN, compute 


|CNF(I,L,| JmJE x («, X (3 t X fyl 

r 1 ifS,, , , 


i#l 


0,L-1 


3. For all flexible bodies L, that is, for those bodies contained in the set defined by 
the integer code word SFLX, compute 

« |FLIRC(I,L)} = • w l + w L X al l L j. 

- . t 

“{[£ ( E N,L + ^(Qn,l))V L w] • "l{ 

, 1 U N,L ' c 

{ FLCRC (I, L) } = |2m L w L X a L j 

■|\ U L^ y J *N,L W A N,l} 

• .... • /'t . . ■ * .... . ;i.l ; A i\.i ' •'SO.N'.l.Sni ^ : SVr.Y :.)/>< J.'fw/i AJi> i 

4. Add gyroscopic loads associated with rigid body motion to that associated with 
relative elastic deformation to obtain 

|ETIC (I, L)| = {ETIC (I, L)[ + |FLIRC(I,L)| 

{CNF (I,.L)| = |CNF(I,L)[ + |fLCRC(I,L)} 
for each flexible body L. 
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5: For each symmetric wheel of the system, compute 

|etmc(i,m)| - {3 moot x h m } c 

6. Sum the gyroscopic loads associated with each body L contained in the nest K-l 
to obtain the components of the gyroscopic load external to the nest K-l ; K = 1 , 
2, . . . , NBOD+1 , as follows: 

a. Initialize the array ETC: 

|eTC(I,K)J. =|o| ; K = 1,2,...,NB1 

b. Add inertia cross-coupling terms for all bodies L contained in the set defined 
by the code word SIX(K-l): 

|ETC(l,K)f = |ETC(I,K)| - £ |eHC(I,L)} 

LeSlX(K-l) 

where 

K = 1,2,. . . , NBOD 

c. Add centripetal cross-coupling terms for all bodies L contained in the set 
defined by the code word SCN(K-l): 

• If body L is a rigid or flexible body 

| CNF. (I, L)| = {c^ 

• If body L is a point mass 

|CNF(I,L)} = |c L - 2m L w L Xa^} 

Let 

...... kM'i.ui {<•;) 

then, for all nests K-l containing one or more rigid bodies 

|ETC(I,K)| = |ETC(I,K)} - X) { : y K . 1 , L x‘c L \ 

LeSCN(K-l) V 7 


72 


and for all nests K-l containing the single-point mass labeled body K 
|etC(I,K)| = |ETC(I,K)[ - 

t 

and for K = NB1 

|ETC(I,K)| = | ETC (I, K)} - 

d. Add Coriolis cross-coupling terms for all point masses (bodies L) contained 
in the set defined by the code word SCR(K-l): 

For all nests K-l containing one or more rigid bodies 
{ETC(I,K)f = ,{ETC(1,K)} -J2 

LeSCR(K-l) c 



For all nests K-l containing the single-point mass labeled body K 

|ETC(I,K) = {eTC(I,K)[ - |2m K w K Xa K l 
and for K = NB1 . 

| ETC (I, K)} = |ETC (I,K)| - ^ { 2m L " L X “4 

where SL is the code word defining ali point-mass body labels. 

e. Add symmetric wheel cross-coupling terms for all wheels M contained in 
the set defined by the code word SMC(K-l): 


|ETC(I,K)f = {ETC(I,K)| . - T3 |ETMC(I,M)} 

. ' M6SMC(K-1) 


where 

‘ K = 1,2,: . .,NBOD' 


For any particular problem, all computation carried out in ETA can be outputted on the 
line printer by defining 

LETA = .TRUE. 

on card 1 of the data deck. 
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PROGRAMMER'S GUIDE TO SUBROUTINE TORQUE 


The primary purpose of subroutine TORQUE is to provide a place for the user to define the 
nongyroscopic forces and torques acting on the particular problem under investigation. In 
Reference 1, pages 41 through 53, several nongyroscopic effects commonly encountered in 
the analysis of spacecraft attitude dynamics are described along with the methods that must 
be used to enter their resultant effects into the equations of motion. This section will define 
the coding (by example) that is required to interface with N-BOD2. 

The following variables are defined in table 1 and computed by user defined algorithms in 
TORQUE: 

|PHI(I,K)| 

|CLM(M)f 

NTQ 

Y(N) N = NEQ+1 , . . . , NEQ+NTQ 
YD(N) N = NEQ+1 , . . . , NEQ+NTQ 

In subroutine TORQUE, the user has access to all computed system state variables. These 
are stored in the various labeled common blocks. Any user-defined function of state variables 
may be computed and stored in array DUMMY in labeled common block /SATELL/. 

The nested body approach has been used to derive the equations of motion presented in 
References 1 and 2. In Reference 1 , equation 88, the forces and torques acting external to 
the nests are contained in the partitions 


while torques acting external to symmetric wheels are contained in the partition 



In Reference 2, equation 111, the forces and torques acting external to the nests are con- 
tained in the partition 



while torques acting external to symmetric wheels are contained in the partition 


The user must define the algorithm that is to be used to compute 

^ PHI(I,K)i — resultant torque (force*) that is acting on and external to the 

* ‘ nest K-1;K= 1, 2, . . ., NBOD 

/PHI(I,NBI)l - resultant sum of all external forces acting on the composite 

* ' system of coupled bodies 

CLM(M) — • scalar magnitude of the torque acting external to the symmetric 

wheel M 

Frequently the algorithm involves the integration of differential equations such as in the 
description of an onboard control system. The user must define 

NTQ — total number of differential equations that are defined by the 

user in TORQUE and which must be integrated. 

The state variables and associated time derivatives for all first order differential equations 
defined in TORQUE are stored in the arrays Y and YD. 

Let 


where 


N = NEQ + M 
M = 1,2,..., NTQ 


then' 


Y(N) = storage location to the state variables associated with the With 

differential equation defined by the user in TORQUE. 

YD(N) = storage location of the time derivative of the state variable stored 

in Y(N). 

To code subroutine TORQUE, the user should first zero out the external torque matrix upon 
entry. The resultant torque matrix is then obtained by vector addition of the various com- 
ponents. Thus, the first executable statements of TORQUE should be 

C ZERO ALL ELEMENTS OF EXTERNAL TORQUE MATRIX 
DO 1 K= 1.NB1 

DO 1 1 = 1,3 

1 PHI <I,K) = 0.D0 
DO 2 M = 1 , NMO 

2 CLM(M) = Q.DQ 


•Force if body K in nest K-l is a point mass. 
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Motion about or along any free coordinate vector may be constrained by springs, dashpots, 
or motors. The computation of the associated reaction loads and their inclusion into the 
equations of motion are discussed in Reference 1 , pages 42 through 45. The following coding 
is to be used to include these effects in N-BOD2: 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


REACTION TORQUE ACTING ACROSS OR ALONG GIMBAL AXIS M 
AT HINGE POINT K-l DUE TO 
L INEAR SPRINGS * ■ 

LINEAR VISCOUS HAMPERS 
MOTORS 

LET : 

S PR { M ) = SPRING CONSTANT ABOUT OR ALONG G'l MB AL AXIS M 
(M*L**2/T**2 OR M/T**2) 

OPC(M) = DAMPING CONSTANT ABOUT OR ALONG GIMBAL AXIS M 
(M*L**2/T OR M/T) 

CLT(M) = CONTROL TORQUE APPLIED BY MOTOR ABOUT OR ALONG GIMbAL 
AXIS M M*l**2/T**2 OR M*L/T**2 


DIMENSION TEMI3) 

C ‘ SPRING TORQUE * 

C SPR(M) - USER INPUT 

A = SPR(M)*THA<M! 

CALL SCLV ( A , OFC ( 1 ♦ M ) , T EM ) 

-CALL V6CSUB (PHI (l*K)tTEM»PHl( 1 * K ) ) 

C OAMPER TORQUE 

C DPC(M) = USER INPUT 

A = DPC(M>*THAD(M) 

CALL SCLV(A,QFC( 1,M),TEM) 

CALL VECSUBI PHI ( 1 ,K ), TEM, PHI ( 1 *K ) ) 

C MOTOR TORQUE 

C CLT(M) = FUNCTION OF STATE VARIABLES, USER OEF . 
CALL SCLVICLT(M) ,OFC( 1»M) ,TEM ) 

CALL VECADDIPHI ( 1 , K ) , T EM , PH I ( 1 , K ) ) 




Symmetric wheels are usually used to simulate controlled momentum wheels. Since wheels 
have only one degree of freedom, it is not necessary to compute wheel torque as a vector 
quantity. The following coding is to be used to include this effect in N-BOD2: 


c 

c 

c 

C REACTION TORQUES ON SYSTEM DUE TO A CONTROL TOROUE 

C APPLIED TO MOMENTUM WHEEL MW 

C LET: 

C CLM(MW) = CONTROL TORQUE APPLIED TO WHEEL MW ABOUT ITS SPIN AXIS 

C USER DEFINEO FUNCTION OF STATE VARIABLES ( M*L**2/T**2 I 

C 

C C CL M ( MW ) = USER DEFINED FUNCTION OF STATE VARB. 

C 


Locally applied forces may be applied to any body of the system; they may not be applied , 
to symmetric wheels.directly. The computation of the reaction loads and [.their inclusion, jnto aT 
the equations of motion are discussed in Reference 1 , page 45. The following coding is used 

to include this effect in N-BOD2: 

c 

C 
C 
C 

c 
c 
c 
c 
c 
c 
c 
c 


REACTION TORQUES ON SYSTEM DUE TO A LOCALLY 
APPLIED EXTERNAL FORCE (I.E. A GAS JET) 

LET: ' 

J = INTEGER LABEL ASSIGNED TO GAS JET 
L = BODY TO WHICH EXTERNAL FORCE DIRECTLY APPLIED 
R J ( I ) = RADIUS VECTOR FROM CENTER’ OF MASS OF BOOY- L TO 

GAS JET J, (COMPONENTS RELATIVE TO BODY L COORDINATES) 
F J II) = COMPONENTS OF APPLIED FORCE DUE TO GAS JET- J, (RELATVE 
TO BODY L COORDINATES) USER DEFINED FUNCTION OF STATE 
VARIABLES <M*L/T**2) 
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c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


DIMENSION RJCI3V ,FJU3V| TEMI3I ,TEMY \i\ ,FJt3> 
INTEGER SI ( 10) ,NS1 , . * ■ f 

LOGICAL CTAIN - 1 

C RJ( 1) = USER INPUT . , # ' v 

CALL VECTRNIRJ, XHC< l«l«D«fUC > 

C F J I I) = USER REFINED FUNCTION OF STATE VARIABLES 

CALL VECTRN(FJ,XMCU,1.L),FJC) 

CALL VECADOIPHI ( 1 t NBl ) ♦FJC.FHI ( l,NBl) ) 

00 3 K= 1 t NBOO 
CALL UNPAC (S1»NS1»SK(K-IM 
IF(.N0T.CTAINIL,S1»NS1 M GO TO 3 
IF(RBLO(K> ) GO TO A 

CALL VECAODIPHI < 1,K ) ,FJC, PHI ( 1 ,K ) > 

GO TO 3 

A KL = KTO(NBl'K-l, U 

CALL VECADO(GAM( 1 t KL),RJC»TEM) 

CALL VECROS ITEM,FJC,TEM1 ) 

CALL VECADOIPHI ( l t K) ,T EMI, PH 1. 1 1,K ) ) 

3 CONTINUE 


The system to be modeled may be in a gravitational field; i.e., an Earth-based system. The 
computation of the reaction loads and their inclusion into the equations of motion are dis- 
cussed in Reference 1 , pages 45 and 46. The following coding is used to include this effect 
in N-BOD2: 


c 

c 

C REACTION TOROUES ON SYSTEM DUE TO GRAVITATIONAL 

C EFFECTS ON AN EARTH BASED SYSTEM 

C LET:' 

C GRAV = ACCELERATION OF GRAVITY (L/T**2) 


C 

C 

C 

C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

C 

c 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


RH(I) <= COMPONENTS OF UNIT VECTOR FROM INERTIAL ORIGIN TO COMP. 
SYSTEM CENTER OF MASS* (RELATIVE TO INERTIAL FRAME) 

THAT IS, PARALLEL TO OIRECTION OF GRAVITY FORCE 

INTEGER SIT 10) ,NS1 

DIMENSION TEM(3),BHC(3)*BH(3) .... 

C BHU) = U5ER INPUT , 

CALL VECTRNI BH f XMC< 1, 1.0), BHC > 

DO A K= 1 , NROD * 

C GRAV = USER INPUT 

A = XMASIK )*GRAV 
CALL SCLVCA, BHC,TEM) 

CALL VECSUBIPH! ( 1 ,NB1) , T EM* PH I ( 1 , NR 1 ) ) 

IF(RBLOIK) ) GO TO 5 

CALL VECSUBIPHI I 1 , K ) , T EM , PH 1 I 1 , K ) ) 

GO TO A 

5 CALL UNPACI S1,NS1 ,SK(K-1 ) > 

DO A LL= 1 ,NS1 
L = S 1 1 LL ) 

KL = KT0(NB1,K-1,L ) 

A = XMAS(L)*GRAV 
CALL SCLVI A, BHC, TEM ) 

CALL VECROS IGAMI 1 ,KL ) »TEM,TEM1 ) 

CALL VECSUBI PHI ( 1 ,K ) ,TEM1 , PHI ( 1 ,K ) ) 

A CONTINUE 


The system to be modeled may be in orbit and subject to gravity gradient effects. The com- 
putation of the orbit and the gravity gradient torques a^ediscussedfin.Re.feren'ee 'lv v pages 4'6' 
through 52. 'The following coding is used to include these effects in N-B0D2: 


c 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 


LET: 

CBI 1,0) 


asm 

ECC 

TPP 

GEV 

ETE 

AME 


KEPLERI AN ORBIT 

COMPONENTS OF VECTOR FROM EARTH'S CENTER TO COMPOSITE 
SYSTEM CENTER OF MASS, RELATIVE TO INERTIAL REFERENCE 
FRAME, ORBIT ASSUMED TO BE IN INERTIAL 2-3 -PLANE 
SEMI-MAJOR AXIS OF ELLIPTIC ORBIT INERTIAL 2 DIRECTION 
ORBIT ECCENTRICITY 
TIME OF PERIHELION PASSAGE, < T ) 

EARTH'S GRAVITATIONAL CONSTANT, ( L**3/T**2 ) 

MEAN MOTION 
MEAN ANOMALY 
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onooonoooonr><->ooooonnpnponooooonnoono< n '-'<''>r>onnnooooononaoooo ooooooonoooonooooooono noon 


/ 


/ 


ECE = ECCENTRIC ANOMALY 

TVE = TRUE ANOMALY 

BTO = MAGNITUDE OF CBU*0), IL> 


C ASM = USER INPUT 

C * GEV = USER INPUT ' 

ETE = l./SORTIASM**3/GEV) 

C TPP = USER INPUT 

AHE * ETE*i T-TPP > 

SMI * SINIAMEI SMA = SIN(4*AME) 

SM2 = S IN I 2*AME ) 

SM3 = $IN<3*AME1 
C ECC = USER INPUT 

ECE * AME ♦ ECC*5M1 ♦ ECC**2*SM2/2 

* +ECC**3*(9*SM3 - 3*SMU/<24) 

* +ECC**4*(64*$M4 - 32*SM2)/192 
CE * COSIECE) 

SE * S IN ( ECE ) 

BTO = ASM* ( I - ECC*CE ) 

CB( 1*0) = 0 

C8 ( 2, 0 ) * BTO* ( ( CE— ECC)/<1 - ECC*CE>> 
CB(3*0) * BTO*( SORT! I-ECC**2)*SE/(1-ECC*CEM 
CALL VECTRNICBI 1,0) ,XMC( 1* 1,0) ,CBCl 1,0)) 


REACTION TORQUES ON ORBITING SYSTEM OUE TO 
GRAVITY GRADIENT EFFECTS 

LET: 

CBC I I , l ) = COMPONENTS OF VECTOR FROM COMPOSITE SYSTEM CENTER OF 
MASS TO CENTER OF MASS OF BODY 1, RELATIVE TO 
COMPUTING FRAME 

* NOTE FOR GRAVITY GRADIENT OPTION 

* CBC 1*1 ) AND ITS INERTIAL DERIVATIVE 

* ARE REDEFINED TO CIRCUMVENT DIFFERENCE 

* OF LARGE NUMBER PROBLEMS, THAT IS 

* THEY ARE MEASURED FROM COMPOSITE CM TO 

* CM OF BODY 1 RATHER THAN FROM INERTIAL 

* ORIGIN TO CM OF BODY 1 

BH ( I ) = UNIT VECTOR FROM EARTH'S CENTER TO SYSTEM COMPOSITE 

CENTER OF MASS, COMPONENTS RELATIVE TO INERTIAL FRAME 
DFLIIfK) = COMPONENTS OF VECTOR FROM COMPOSITE SYSTEM CENTER OF 
MASS TO CENTER OF MASS OF BODY K 

DFG(IfK) = COMPONENTS OF GRAVITY GRADIENT FORCE ACTING ON BODY K ' 
SGGII) * COMPACTED INTEGER WORD, THOSE BODIES IN THE NEST I 

WHICH SIGNIFICANTLY CONTR I BUT E TO GRAVITY GRADIENT EFF. 
BTO = DISTANCE FROM EARTH'S CENTER TO COMPOSITE SYSTEM CM 

DIMENSION DEU3,10> *DFGI3,10),BHCI3),BHI3) ,TEMI3) ,TEM1I3) 
INTEGER SGG (0,9), Sl(lO) 

C KEPLERIAN ORBIT MUST BE USED WITH GRAVITY GRADIENT OPTION 

00 10 1=1,3 

10 BHCIII = CBC ( I ,0 ) /BTO . 

DO 7 K= 1 , NBOD 

KL = KTOI NB1,0«K.) * 

CALL VECADD ( CBC ( 1 , 1 ) »GAM ( 1 , KL ) , DEL I 1 , K > ) 

CALL VECDOT I BHC »DELI1»K)»A) n 

A = 3*A 

CALL SCLV<A,BHC,TEM) 

CALL VECSUBIOELI 1»K) ,TEM,TEM) 

A = -GEV*XMASIK)/BT0**3 ; - 

CALL SCLVI A, TEM, DFGI 1»K ) ) * 

7 CONTINUE 

DO 8 K = 1 , NBOD - - 

1FI RBLOIK) ) GO TO 9 

• CALL VECADD (PH I ( 1 , K )_, DFGI.l , K) , PHI (,1 , K ) ) j • * 

1 ’ GO* TO ' 8^* ^ A ' : ' 

C SGGII) = SKID IF ALL BODIES CONTRIBUTE TO GRAVITY GRAD. 

C EFFECTS. IF NOT USE COMPAC TO CONSTRUCT 

C SGGII) FORM USER INPUT OR DEFINE DIRECTLY 

9 CALL UNPAClSl f NSltSGGlK-l) > 

DO 8 LL=1»NS1 
L = S1ILL) 

KL = KT0INB1, K— 1 , L ) 

CALL VECROS I GAM I 1 , KL ) , DFG ( 1 • L > • T EM ) 

CALL VXDYOVI BHC,XICI ltl,L )*TEM1) 

A = 3*GEV/8T0**3 
CALL SCLV(A,TEM1,TEM1 ) 

CALL VECADD!TEM,TEH1,TEM) 

CALL VECADDIPH1 ( 1,K),TEM,PHI I 1,K) ) 

8 CONTINUE 
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As previously mentioned, it is often necessary to integrate several differential equations to 
define control torques in TORQUE. The following coding is used to include additional dif- 
ferential equations for integration by N-BOD2 along with the system equations: 


c 

c 

c 

c 

c 


LET: 


parameters defined by first order 

DIFFERENTIAL EQUATIONS 

NT Q * TOTAL NUMBER OF FIRST ORDER DIFFERENTIAL EQUATIONS TO 


C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


BE SOLVED FOR USE IN SUBROUTINE TORQUE 
TQIN) = MAGNITUDE OF PARAMETER NUMBER N DEFINED WITHIN SUB. 
TORQUE AT TIME T 

TODIN) s TIME DERIVATIVE OF PARAMETER TQIN). A USER DEFINED 
FUNCTION OF THE SYSTEM'S STATE VARIABLES 

DIMENSION TQ I 20 ) ♦ T QD ( 20 ) 

C FOR THE PARAMETER N 

IF (CT4.NE; 1 ) GO TO 11 

. C • YINEQ+N) = TQIN) = INITIAL VALUE FOR TQIN) 

11 TQIN) » YINEO+N) 

C TQD(N) = USER DEFINED FUNCTION OF STATE VARB. 

C 

C AFTER DEFINITION OF LAST DIFFERENTIAL EQUATION 

C NTQ = TOTAL NUMBER OF FIRST ORDER DIFFERENTIAL 

C EQUATIONS TO RE SOLVED FOR USE IN TORQUE 

DO 12 N= 1 »NTQ 

12 YDI NEQ + N ) = TQD(N) 


At times, appendages on spacecraft are subject to thermally induced motion. This is dis- 
cussed in Reference 1 , pages 52 and 53. The following coding is used to include this effect 


in N-BOD2: 


c 

c 

c 

c 

c 

c 

c 

c 

c 

.c 

c 

c 

c 

c 

c 

c 

c 

c 

c. 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


THERMALLY INDUCED MOTION ABOUT G I M B A L AXIS M 
AT HINGE POINT K-l 

ASSUME: 

ALL THERMALLY INDUCED DEFLECTION IS SMALL ANGLE 

RELATIVE TO THE SYSTEM'S NOMINAL ZERO STRESS STATE 
THERMALLY INOUCED DEFLECTION IS MODELLED AS A MOVEMENT 
OF THE ZERO STRESS. STATE 

ACROSS ALL HINGE POINTS SUBJECT TO THERMAL DEFORMATION 
SPRINGS AND DAMPERS ACT 

A RESONABLE MODEL OF THE THERMAL INPUT CAN BE OEFINED 
IN TERMS OF THE SYSTEM'S STATE VARIABLES 
THERMAL EQUILIBRIUM POSITION ABOUT ANY GIMHAL AXIS IS DEF. 
BY SOLUTION OF THE HEAT CONDUCTION EQUATION 

LET: 

SPR(M) = SPRING CONSTANT ACROSS GIMRAL AXIS M 
DPC(M) = DAMPING CONSTANT ACROSS GIMRAL AXIS M 
v TAU(M) * THERMAL TIME CONSTANT FOR DEFORMATION ABOUT GIMBAL 
AXIS M, <T) 

TQIN) - THERMAL EQUILIBRIUM POSITION FOR THERMAL DEFORMATION 
ABOUT GIMBAL AXIS M t (RAD) 

TQD(N) =- RATE OF CHANGE OF THERMAL EQUILIBRIUM POSITION ABOUT 
GIMBAL AXIS M t FIRST ORDER 0 1 F F • E0-. (RAD/T) 

TINP = THERMAL INPUT USER DEFINED ,FUNCT..I ON. OF STATE VAR I ABLE S » 

IRAO/T) 1 ' ' 1 • r « » . J- - V - 

DIMENSION TEMI3) 

C N = USER OEFINED LABEL * DE PENDS . UPON . EQUAT ION NUMBERING 

C SEQUENCE*' DEF INEO WITHIN' SUBROUTINE- TORQUE 0 

IFICTA.NE.l ) GO TO 13 

C YINEQ+N) = TQIN) = INITIAL VALUE FOR THERMAL DEFORMATION 

C ABOUT GIMBAL AXIS M. USER INPUT 

13 TQIN) = YINEQ+N) 

C TINP = USER DEFINED THERMAL INPUT FOR THERMAL DEFORMATION 

C ABOUT GIMBAL AXIS M 

C TAU(M) s USER INPUT 

TQD1N) = -TQ I N ) /TAU I M ) + TINP 
A = SPRIM) *1 THAIM ) - TQ(N) ) 

CALL SCLVI A,OFC( 1»M) ,TEM) 

CALL VECSUBIPHI ( 1 t K ) , T EM * PH I I 1 , K ) ) 

A = DPC(M)*THAD(M) 

CALL SCLVI A,QFC( 1 »M) ,TEM) 

CALL VECSUBI PHI! 1,K) ,TEM t PHl I 1 ,K) ) 
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For any particular problem, all computation carried out in TORQUE can be outputted on 
the line printer by defining 

LTORQU = .TRUE. 

on card 1 of the data deck, if the user codes the print statements. 

PROGRAMMER'S GUIDE TO SUBROUTINE QFDOT 

The primary purpose of subroutine QFDOT is to eliminate the forces and torque's associated 
with kinematic constraints. In so doing, the coupled vector-dyadic equations of motion will 
reduce to a. set of simultaneous scalar differential equations. The user need never interface 
with this subroutine. . , 

The equations of motion to be integrated are given in Reference 2 by equation 136. This 
equation, in the absence of body flexibility, reduces to equation 144 of Reference 1 . Making 
use of the array names used in the coding of N-BOD2, the equation takes on the general form 

[xmn] |thadd[ = |etm[ 

where, to be consistent with the coding of N-BOD2 and the notation of Reference 2, 

(® 

{tHADd} = I a 

: ; : ^ 

r This matrix equation defines exactly 

. NFER + NMODS + NMV ' 

scalar second-order ordinary differential equations. 

The following variables are defined in table 1 and computed in QFDOT: 

[XMN (M,N)] • 

|ETM(M)| 

The elements of these arrays are obtained by carrying out the vector-dyadic operations de- 
fined by the partitioned matrix equation 136 of Reference 2. 

The equations coded in N-BOD2 assume that all hinge points and symmetric wheel attach- 
ment points are either on rigid bodies or at node points of flexible bodies. The restriction 
in modeling capability implies that in equation 136 of Reference 2, the following is true: 
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■ ■' ■■ •• ^ h r = °. . , .. • ■- .. , 

? W R = 0, and 

-- O H T = 0 . 

Furthermore, it is assumed in N-BOD2 that the user will not need to cbmjpute forces of cori- 
straint;.that is, the elements of the partition F c . 

Introduction of these two modeling limitations significantly simplifies the required coding. 
The coding is structured so that, if required at a later date, both limitations can be removed 
by simple insertions into QFDOT and other relevant subroutines. Making use : of the above- 
assumptions, the.equations coded in N-BOD2 are from equation 1 36 of Reference. 2. 



Coding requirements force a rearrangement of rows and columns from that used in the theo- 
i retical development. The following storage allocation scheme is used: 

i ■ . ’ 

• [XMN (M, N)] = [q T J • [X] • [qj 

where: M = 1, . . . , NFER , . ■; 

N = 1, . . . , NFER , 
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• [XMN (M, N)] = [q T J • [Fj 

where M = 1 , . . . , NFER 

N = NFER+1 , . . . , NFER+NMODS 

• [XMN (M, N)] = [q T J • [l c ] • [hj 

where M = 1, . . . , NFER 

N = NFER+NMODS+] , . . . , NFER+NMODS+NMV 

• [XMN (M, N)] = [M 1 ] 

' where M = NFER+1 , . . . , NFER+NMODS 

N = NFER+1,. . NFER+NMODS 

• [XMN (M, N)] = [0] 

j where M = NFER+1,. . ., NFER+NMODS 

N = NFER+NMODS+1 , . . ., NFER+NMODS+NMV 


• [XMN (M, N)] = lh T J [I s ] [hj 

where M = NFER+NMODS+1,. . ., NFER+NMODS+NMV 

N = NFER+NMODS+1, . . . , NFER+NMODS+NMV 


{ETM (M)[ = lq T ] • {jr?,} + |^ e) } - [x] • [qj |0fj 


where 


M = 1, 2, . . . , NFER 
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0 |ETM(M)| = |rj 3 1 - L fT JIAJ|<? } 

where M = NFER+1 NFER +NMODS 


• {ETM (M)} =lh T J*{|r, 2 } + |CL| - [l cT ] [qj { $ }} 

where , M = NFER+NMODS+1 , .... NFER+NMODS+NMV 


In the computation of the ETM array, the contents of the ETC array defined in subroutine 
ETA are changed. In ETA, the components of the vector in row K of jrjjJ are stored in 
{ ETC ( I ,K ) f . In QFDOT, the components of the vector in row K of 

+ ^ (C) f - M 

are stored in | ETC (I, K) | . 

In the computation of the full XMN array only the nontrivial entires of XMN are computed, 
and the lower triangular portion of the array is obtained by making use of the fact that the 
array must be symmetric. To ensure that all redundant and trivial operations are circum- 
vented, the labels stored in the integer code words 

SI, SK, SR, SCXC, SMV, SOK, SQF, 

JCON, SFCC, SFLX, and SFXM 

are used extensively. ... 

For any particular problem, all computation carried out in QFDOT can be outputted on the 
line printer by defining 

LQFDOT = .TRUE. 

on card 1 of the data deck. 
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PROGRAMMER'S GUIDE TO SUBROUTINE DCT 


The primary purpose of subroutine DCT is to set up the differential equations required to 
compute the elements of the transformation matrices that are to be obtained by direction 
cosine techniques. The user need never interface with this subroutine. 

In Reference 1 , equation 119, the direction cosine equation is given in a form compatible 
with this coupled body analysis; namely 



N-BOD2 is coded to integrate only six of the nine-equations defined for each transformation 
matrix that is to be derived by direction cosine techniques. The other three parameters of 
the respective transformation matrices are obtained in TRAN from orthogonality conditions. 

The following array is defined in table 1 and the elements of it are computed in DCT: 

YMCD (U,K). 

In DCT, a unique numbering sequence is used to facilitate the handling of the direction 
cosine data. The body labels stored in the integer code word SD are obtained first. Let 

Xj , \ 2 , . . . , \ N = . body labels associated with those body fixed-reference 
frames for which transformation matrices are to be ob- 
tained by direction cosine techniques 

where 

Xj > X 2 > . . . > \ N .. . -• •••■'• 

If X N =1 and the body 1 fixed frame is the frame of computation, then to obtain the trans- 
formation matrix between inertial and body 1 coordinates, 


« r 






Jymcd (i, i,i)[ = r<| 0 

“Vt i r ;T. 'n f 1 f j r J > if. . _ i y t U. I J /■ , 




{ YMCD (1, 2, 1) [ • = [ C # 0 J 


o 

i-1- 

. 0 . 



and for the rest, M = 1 , 2, . . . , N-l 


jYMCDl 


j 

l ) 

[.<] 

[°j 


' 0 ' 


• > 


Otherwise, for M = 1 , 2, . . . , N, 


:l 

(°) 

r — 

•<* 


L c M J i 

( 0 I 



1 a 

1 

. s 



A 




i 

r Ox 

r • l . ' 

| / 


r 

L c a mJ • j 


'o' 


For any particular problem, all computation carried in DCT can be outputted on the line 
printer by defining 

LDCT = .TRUE. . ; 

on card 1 of the data deck. 


PROGRAMMER'S GUIDE TO SUBROUTINE ANGLE 

The primary purpose of subroutine. ANGLE is to set up the differential equations required 
to compute the displacement coordinates that are measured about or along the free coordinate 
vectors. The user need never interface with this subroutine. 

The following array is defined in table 1 and the elements of it are computed in ANGLE: 

ANGD(N) - time derivative of the displacement coordinate associated with the 
motion about or along the free coordinate vector SFR(N); N = 1, 2, 

. . . , NFRC 

In Reference 1 , pages 37 and 38, the differential equations which define relative displace- 
ment about or along free coordinate vectors are defined. These equations are coded in 
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ANGLE. The user has the capability by subroutine INOPT to select which displacement 
coordinate should be evaluated. The integer array SFR defines the selected coordinates. 

Several special cases are recognized in ANGLE: 

• If relative translational motion is measured along free coordinate vector 

M = SFR (N) 


then 


ANGD (N) = THAD (M) = 0 M 


r-v ■ 


Ht : 'v n‘ 


(Point mass motion or body 1 center-of-mass motion.) 

If free coordinate vector 

M = SFR (N) 

is aligned with the gimbal axis of a one-axis gimbal, then 
ANGD (N) = THAD (M) = 0 M 

If the free coordinate vectors 

M = SFR (N) and 
M+l = SFR (N+l) 

are aligned with the gimbal axes of a two-axis gimbal at hinge point K-l , then 

^ - S M+1 
A 1 S M W K 
A 3 = S M + 1 ’ W K 


,and .. 


f J J* J ‘;H* 



. A. - OA, 

ANGD(N) = M 1 " " 1 

1 - C 2 



ANGD (N+l) =- 


- C*Aj 

- C 2 
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• If the free coordinate vectors 

M + i = SFR (N + i) i = 0, 1 , 2 

are aligned with the gimbal axes of a three-axis gimbal at hinge point K-l , then 
* 1 

. ^ %i+2 

— ► 

A 1 = 4 * 

- 

\ ~ %1 + 1 * W K 

; ’ V ‘ ; v t> 

->• 

^3 = %! + 2 W K 

and 

' A 1 “ C * A 3 

ANGD (N) = 

1 - C 2 

ANGD (N + 1) = A 2 

A 3 - C * Aj 

ANGD (N + 2) 

1 - C 2 


For any particular problem, all computations carried out in ANGLE can be outputted on 
the line printer by defining 

LANGLE = .TRUE. 

on card 1 of the data deck. 

PROGRAMMER'S GUIDE TO SUBROUTINE SETUP 

The primary purpose of SETUP is to provide the necessary interface between tfie symbolic 
array names used in the derivation of the equations of motion in N-BOD2 and the symbolic 
array names used in the integration subroutine RUNGE. .The user need never interface with 
this subroutine. 
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The following sequential ordering scheme, used to define the locations of state variables ahd 
their time derivatives in the Y and YD arrays, is identical to that used in EQIV: 

• Accelerations and rates relative to free coordinate vectors 

YD (N) = THADD (N) ; THAD (N) = Y (N) 

N = 1,2, . . . , NFER 
Sum equations: NEQ = NFER 

• . Accelerations and rates of generalized elastic coordinates 

YD (N) = THADD (N) ; THAD (N) = Y (N) 

, . N = NEQ+1 , , . . , NEQ+NMODS .. « 

Sum equations: NEQ = NEQ+NMODS 

• Accelerations and rates of symmetric wheels with variable rate. Let 

M ,M 2 M = wheel labels in the set defined by integer code word SMV 

YD (N) = THADD (N) ; THADW(Mj) = Y(N) 

N = NEQ+1 , . . . , NEQ+L 
I = 1,2 L 

Sum equations: NEQ = NEQ+L 

• Rate and displacement relative to free coordinate vectors 

YD (N) = ANGD (MM) ; THA (M) = Y (N) 

N = NEQ+1, ... ,NEQ+NFRC 
MM = 1,2,. . . , NFRC 
M = SFR(MM) 

Sum equations: NEQ = NEQ+NFRC 

• Rate and displacement of generalized elastic coordinates 

YD (N) = THAD (M) ; THA (M) = Y (N) 

N = NEQ+1, . . . , NEQ+NMODS 
M = 1,2,..., NMODS 

Sum equations: NEQ = NEQ+NMODS 
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• Rate and angle of symmetric wheels 

YD (N) = THADW (M) ; THAW (M) = Y (N) 

N = NEQ+1 , . . . , NEQ+NMOA 
MM = 1,2,...,NM0A 

i 

M = SMA (MM) 

Sum equations: NEQ = NEQ+NMODS • •» 

• Rate and magnitude of direction cosine : 

Kj ,K 2 , . . . »K jd = body labels'iassociated with the coordinate frames for 

which transformation matrix is to be obtained via direction 
cosine 

YD (N) = YMCD (I, J, M) 

M = 1,2,..., ID 
J =1,2 
I = 1,2,3 

N = NEQ + 6 * (M - 1) + 3 * (J - 1) + l 

xmc(i,j,k m ) = y(n) ; ' • '•* :: 

I = 1,2,3 

J = 1,2 

M = 1,2 ID 

The exact algorithm is obtainable in the discussion of subroutine DCT. 

For any particular problem, all computations carried out in SETUP can be outputted on the 
line printer by defining 

LSETUP = .TRUE. 

on card 1 of the data deck. 
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PROGRAMMER'S GUIDE TO SUBROUTINES OUTPUT AND OUTPSP 

The primary purpose of subroutines OUTPUT and OUTPSP is to provide a convenient place 
to put all output data statements. OUTPUT is entered only at time zero while OUTPSP is 
entered at the end of every integration step unless otherwise directed by the user. The user 
is expected to refrain from modifying subroutine OUTPUT. It provides a useful echo of the 
initial state of the system for checkout purposes., 

Nominally, subroutine OUTPSP is identical to OUTPUT. The user is expected to remove 
unwanted print statements from OUTPSP, add additional computation if desired, and insert 
any other set of desirable output statements. 

The following parameters are outputted on the line printer by subroutine OUTPUT : 

TIME - simulation time t 

CENTER OF MASS — components of the vector from hinge point 0 to the center-of- 
mass of the composite system relative to the frame of computation 

TOTAL SYSTEM MASS — total mass of the system 

SYSTEM INERTIA TENSOR — components of the total system inertia tensor relative 
to the composite system center -of-mass and relative to the frame of computation 

ANGULAR MOMENTUM — magnitude of the total system inertial angular momentum 
vector 

HBODY - components of the total system inertial angular momentum vector rela- 
tive to body 1 fixed coordinates 

* HINERT — components of the total system inertial angular momentum vector rela- 
tive to inertial coordinates 

LINEAR MOMENTUM — magnitude of the total system inertial linear momentum 
vector 

LBODY — components of the total system inertial linear momentum vector in com- 
puting frame coordinates 

KINETIC ENERGY — kinetic energy of total system" " • • 

After the above parameters are printed, a block of data for each body of the system is printed: 

BODY K — body label for the body for which the adjacent block of data applies; 

K= 1,2, . . . , NBOD 

ROMC = |ROMC(IK)| = |w K } 

FOMC = |FOMC(IK)} = 
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ACC ~ 

not in common = j 
BTC - /ETC(«)| „ 




Page 83 


pm = 


l p M(iX)l 


CAC = 


see TORQUE 

1 CAC <‘*H -fa} 

CBC ■ lacajoi .faj 


POS = 


not in common = 


(H 


VEL = 


XMC = 


not in common =f? JK j 


xrc •_ 


hb 


[X,C <U,K) ] , p, 


J 

; C 


not in common = 


EM = 


not in common 


* Kk} 

' n 


- K} 

* c 


tk 


n°t in common 


1 

2 


K ’ (* A • w + m -* 

K %T IjK X^ k) 


+ m «lK-% K + £ 




M M7 ^ V M ’ H *J 

MO(M>=k 
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The block of data pertinent to the translational motion of the center -of-mass of body 1 is 
given adjacent to the title, “ORIGIN.” 


FOMC 

= |fomc(i,nbi>| 

-i?,l 

c 

ACC 

= not in common 

-1X1. 

c 

CBC 

= |CBC(I,0)} 

-l?„l 

c 

ETC 

= |ETC (I, NB1)[ 

= See QFDOT 

PHI 

= jPHI (I, NB1 j| 

' = See TORQUE 

XMC 

= {xMC(I,J,0)i 

= [c^ol 


For each symmetric wheel of the system, the following data are outputted: 

— > 

HMOM(M) = IH m I 
CLM(M) = ICL m I 

For each flexible body of the system, a block of data associated with its flexible body charac 
teristics is outputted: 

FLEXIBLE BODY K - body label for the flexible body for which the adjacent block 

of data applies 


EP = • 

K) 

” K ^ { A N,k} a N,K (t) 

K N.K V K 

EPD = | 

*4, 

= S VVk} 



N,K C 

QD = 

E 

N,K 

\Qn,k} k a N, K W 

El = 

E 

1 E N,k 1 a N,K ^ = [ A<J> ]k 


N.K 


EID = 

E 

N,K 

I E N,k 1 a N,K^ = 

K 

. • ! • -- * - 

FIR = |fLIRC (I,K)} = See ETA 
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FGR = 
DHM = 


|FLCRC(I, K)} = See ETA 

Xrf { Q N,k} a N,K W = | AL X,J 
N,K /e , 1 /c 


Following the last block of flexible body data, the system state variables associated with 
relative body motion and flexible body motion are printed: 


ForM = 1,2, . . . , NFER 


THA (M) 


V 

THAD (M). 

.= Vf^v 


THADD (M) 

•= e M (0 


QFC(M) 

= | Q FC (!, M)[ c : = I q M | 



For MN = 1,2,. . . , NMODS and M = NFER+MN 

i-j TH A (M) , - a N K (t) 

, THAI) (M) •= a N K (t). 


where 


THADD (M) = a N K (t) 

f y ‘ . 

K-l 

MN = N + ^2 SFXM(I) ' f~~-‘ 
i=i 

K = 2, 3, . , . , NBOD 

N = 1,2,..., SFXM (K) [See INOPT, subsection 15] 


All of the above data will be printed at the end of each integration step. The user is expected 
to delete the undesired print statements from OUTPSP and to insert those more applicable to 
the problem at hand. 
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PROGRAMMER'S GUIDE TO THE UTILITY ROUTINES 

The utility routines required by N-BOD2 are: . 

SIMQ — used to obtain the solution to a set of simultaneous linear equations of 
the form 

[X] l»l “ I’ll 

A standard fedUction techniq'ueTs used to solve for |0| without ever 
obtaining the inverse of the coefficient matrix. 

RUNGE — used to numerically integrate the set of simultaneous nonlinear differ- 
ential equations, 

|y(t)} = |F (t)[ 

Fourth order, fixed-step Runge-Kutta integration is used. 

COMPAC — used to create integer code words. 

Integer code words are used primarily to conserve computer storage. This was a critical 
factor on the small XDS-9300 computer on which N-BOD2 was originally debugged. 

Let 

(Ii,I 2 , . . . ,I N ) 

be a set of unique integer labels so that 

1 < I. < 24 ; i = 1,2,... ,N 

and 

N ^ 24 

If computer storage is limited, it is a waste of computer storage to reserve 24 words of mem- 
ory to store this set. 

All integer code words are 32 bits long.* - These bits may be numbered as shown below: 

2ioi39v imotans-rt — (flV .AdJ' .AV) Hd'DW 

32 1 31 1 30 1 29 28 | 27 | 26 | 25 24 | 23 | 22 | 21 20 |19 1 18 1 17 16 1 15 1 14 1 13 12 |11 1 10 | 9 8 | 7 | 6 | 5 4 | 3 | 2 | 1 

*IBM 360 Computer, subroutine must be modified for computers having different word lengths. 
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COMP AC stores the number of labels (N; N < 24) in bits 25 through 32. The set of integers 
Ij , I 2 , . . . , I N are stored in bits 1 through 24. For J = 1 , 2, . . . , 24, if bit J = 1 , J is a 
member of the set; if bit J = 0, J is not a member of the set. 

UNPAC — used to decode the integer code words created by COMPAC 

KTO and KT1 — integer function subprograms used to assign storage area locations 
in one-dimensional arrays for elements of triangular or symmetric 
matrices; another tool used to conserve storage requirements: 


KTO (N, J, K) 


K (N - 1) + J + 1 - K (K - l)/2 K< J 

J (N - 1). + K + 1 - J (J - l)/2 K> J 


J = 0,1,. . . , N-l 
K = 0,1,. . . , N-l 


KT1 (N, J, K) 


(K - 1) (N - 1) + J - (K - 1) (K - 2) /2 K < J 

(J - 1) (N - 1) + K - (J - 1) (J - 2) /2 K>J 


J = 1,2,. 

. . , N 

K = 1,2,. 

. . , N 


CTAIN — logical function subprogram used to determine if a particular integer 

is contained in a particular set of integers 

CTAIN (I, S, N) = .TRUE, if the integer I is contained in the set of 
integers S (1), S (2), ..., S (N) 

= .FALSE, if it is not 

VECTRN (VA, TBA, VB) - transform vectors ( 

I'Ib - 1„^] l'l A 

TENTRN (XA, TBA, XB) — transform dyads 

Mb " Ma M 
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VECNRM (V) 


- normalize vector to unit magnitude 



Error message if v • v = 0 ; inputted vector destroyed 
MATMUL (Aj B, C, N) - multiply two N X N matrices of scalars 

[C] = [A] [B] ... 

TRNSPS (TBA) — transpose a 3 X 3 matrix of scalars 

[TEM] = [TBA] t 

[TBA] = [TEM] 

Inputted matrix destroyed 

ROT (A, J, T) - forms transformation matrix for rotation about a coordinate 

axis 

A — sine of the rotation angle , 

J — axis about which positive rotation is measured ; J = +1 , - 1 , +2, -2, +3 or -3 
Define: 

JJ = I J I 

v, = o 




Redefine : 

V J; = A*J/JJ 
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Then: 


A - V - V 3 2 - V 3 


[T] = 


Z 1 - V , 2 " V 3 2 


- V ! 


h -V !- v 2 2 


VECADD (VI , V2, S) - add vectors 


S " * ! + % 


VECSUB (VI , V2, D) — subtract vectors 


D = v, - v 2 


SCLV (SC, V, P) - multiply vector by a scalar 


P = SC * v 


VECDOT (VI , V2, D) — vector dot product 


D = v j • v 2 


VECROS (VI , V2, C) — vector cross product 


C = v i x v a 


TRIPVP (VI , V2, V) — special triple vector product 


DYADD (D 1 , D2, D) - add dyads 


v=v,x(j; x^ 2 ) 


D = D, + D 2 


SOLD (A, D, T) - multiply dyad by a scalar 


T = A* D 



DYDOTV (A, V, D) 


— dyad dot vector 

D = A • v 


VXDYOV (VI , D, V) - special vector cross dyad dot vector 


v =v, X (D • Vj) 


DYTOV (D, VI, V) 


- dyad transpose dot vector 


= D t •' 


VODYOV (VI , D, V2, SC) — vector dot dyad dot vector equals scalar 


SC = v’j • (D • t 2 ) 


DYOP (V, D) * 


— skew operator ./ 
D =SP(y) 


0 v 3 -v 2 


V 3 0 


I V - V 

L- » 2 Yj 


'1 

0 J 


SUEOP (VI , V2, XM, D) — construct pseudo-inertia tensors 


i .9 ,9 - .a ,o) S 

QUTMUL (Ql, Q2, P) 


D = m [(v t ■ v^) 1 - v 2 v’j] 

(..? ,9 + C S J 9 - £ „9 - 1 9 + S 1 .9 

- multiply quaternions 


P = Q, * Q 2 


QUATOP(QF,THA, ZT) - construct rotation quaternion 

0 = THA 



TRANSO (ZT, TAU) — construct transformation matrix from quaternion com- 
ponent 




g ^ 4. g 2 _ g 2 _ g 2 

6 0 + e i e 2 e 3 

2 < e 0 e 3 + e i e 2 ) 

2 < e i e 3 - 

e 0 e 2> 

[TAU] = 

2 ( e i e ^ e o e 3 ) 

V - e i 2 + e 2 2 * e 3 2 

2( e 2 e 3 + 

e o e j) 


_2(e, e 3 + e 0 

2( e 2 e 3 - e 0 e i) 

e 2 _ e 2 
e o e i 

- V 
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UNCAGE (SCG, SC, T, TUG) — check to see if it is time to uncage any, of the caged 

degrees of freedom. If it is time, redefine SCG and 
SC. 

COMPRS (XMN, THADD, N, SC, SCG, LG) - remove rows from XMN and THADD 

arrays and columns from XMN array associated with 
caged degrees of freedom, renumber and return 
compressed XMN and THADD arrays. 

UNPRS (THADD, M, SCG, LG) — expand THADD array putting zeros in locations 

associated with caged degrees of freedom. 

NOTATIONAL CROSS-REFERENCE 

The equations of motion are derived in References 1 and 2 using standard analytic notation. 
They are programmed in N-B0D2 using FORTRAN IV notation and are outputted on the 
line printer using an abbreviated FORTRAN notation. This section is intended to provide 
the user with a notation cross-reference between the three techniques used to define and 
evaluate the equations of motion. % 

1. Matrix Notation 

| 1 — column matrix 

[ ] — square matrix 

L J — row or rectangular matrix 

2. Vector-Tensor-Matrix Notation 

Vectors and tensors must be stored relative to particular reference frames. A post 
subscript outside of the brace or bracket is used to specify the reference frame in 
which the vector or tensor is defined. For example, 

l — * i “ > 

|V } — 3X1 column matrix of the components of the vector V relative 

to body K fixed coordinates . 

.[Til . — 3 X 3 square matrix of the components of the tensor T R relative 
to the frame of computation 
’ ~ ^ 

If the elements of the vector V K are stored relative to the body K fixed-reference frame in 
the array VE and relative to the frame of computation in the array VEC, 

where 


DIMENSION VE (3 , 1 0), VEC (3 , 1 0), 
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the following notation is used: 


Analytic Notation 
References 1 and 2 

N-BOD2 
FORTRAN IV 
Coding 

N-BOD2 

Users 

Manual 

N-BOD2 

Outputted 

Equations 

|v k I k 

VE-(l.K) 
VE (2, K) 
VE (3, K) 

|VE(I,K)j K 

• VE (K) 


VEC (1 , K) 
VEC (2, K) 
VEC (3, K) 

{VEC (I,K)f c 

VEC (K) 


3. Mathematical Operational Notation 

In the output of the equations of motion, the analytic symbology used to define 
several mathematical operations cannot be duplicated with a standard line printer. 
The following notation has been adopted : . 

Let 

REAL S1.S2.S3, 

VI (3), V2 (3), V3 (3), 

T1 (3, 3), T2 (3, 3), T3 (3, 3), .''.', 1 ;, 

Q1(4),Q2(4),Q3(4), . 

Ml (3, 3), M2 (3, 3), M3 (3, 3) . ; 

define the dimension of the following quantities: 

S1,S2,S3 — storage locations for the scalars Sj ,.S^, S 3 

VI , V2, V3 — storage locations for the components of the vectors 

,i. •y.mttiajo-'-ivoAfi A yboo vw, baiov m -lotudv airfJ lo grnatfiab ani vi 

T1 , T2, T3 — storage locations for the components of the tensors of 
rank two, dyads , T 2 , T 3 

Q1 , Q2, Q3 — storage locations for the components of the quaternions 
v ^2 5 % 

Ml , M2, M3 — storage locations for the components of the 3X3 
matrices of scalars [M 5 ] , [M 2 ] , [M 3 ] 
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The following cross-reference for mathematical operations is used in the output of equations 
of motion: 

• Addition 

S 3 = s i + s 2 « S3 = SI +S2 

v 3 = v 1 , + v 2 * V3 = VI + V2 

T = Tj + T a T3 = T1 +T2 

[M 3 ]= [MJ + [M a ] * M3 = Ml + M2 

• Subtraction 

(Same as addition) 

• Division 


s , 


S 3 

= s 2 

“ 

S3 

= S1/S2 

V 3 

i -> 
" Vl 

as 

V3 

= VI /SI 

T 3 

1 

Tl 

as 

T3 

= Tl/Sl 

Scalar Multiplication 





, s 3 

" S ! S 2 

as 

S3 

'= S1*S2 

— y 
V 3 

“ 

as 

V3 

= S1*V1 

T 3 

= S ! T . 

as. 

T3 

= S1*T1 

[m 3 ] 

= s, [MJ 

as 

M3 

= S1*M1 

Quaternion Multiplication 




<v 

= Q, Q 2 

as 

Q3 

= Q1*Q2 
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Scalar Product 


S 1 

= V > 

— ^ 
V 2 

* SI 

= VI • V2 

■A 

v i 

= T 1 

— y 
V 2 

~ VI 

= T1 • V2 

— ^ 
V 3 

. ** 
II 

* T 1 

as V3 

= V2 • T1 


• Vector Product 


V 3 

= V 1 

X 

v 2 - 

< V3 

= VI 

X V2 

T , 

= V 

X 

T 2 * 

T1 

= VI 

X 

H 

, N-> 

T 3 

II 

►o 

X 

— y 

v i * 

T3 

= T2 

X VI 


• Tensor Product 

T, = Vj a* T1 = VI V2 

• Transpose Matrix 

[MJ = [MJ t * ,M 2 = Ml **T 

• Transform Coordinates of Vectors and Tensors 

If 

[Mj ] — transformation matrix, reference frame A to reference frame B 

V1,T1 — storage area for components of Vj and Tj relative to reference 
frame A respectively 

V2, T2 — 5 ’storage area for components of"Vj and T, relative to reference 
frame B respectively, 

i M * id ~ tM [.MJ ~ j , lvi| 

then 

W = [Mjjv } * V2 = Ml * VI 

1 B 1 A 

[Tj = [MJ [TJ [MJ T T2 = Ml * T1 * Ml * * T 

B 1 A 1 
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• Rotation Quarternion 


Using the notation of Reference 1 (see equations 99, 100, 101 , and A-21), 

s s 

-Cos^-» St (t?,|) Sin J- 

i 

Q1 = QUAT0P(V1,S1) - r. ■ ' 

Subroutine QUATOP makes use of the scalar SI and the three elements stored 
in the array V 1 to compute the four components of the quarternion Q 1 (see 
Utility Routine/QUATOP). 

• Transformation Matrix from Rotation Quarternion 

Using the notation of Reference 1 (see equations 96, 97, 98, and A-18), 

[MJ =^'(Qj) t * Ml = TRANSO(Ql) , 

Subroutine TRANSO makes use of the four elements stored in the array Q1 to 
compute the components of the associated transformation matrix (see Utility 
Routine/TRANSO). 

• Transform Vectors to Tensors 

Using the notation of Reference 1 (see equation 51), 

T ( =^(vj) *= T1 = SKEW (VI) 

• Pseudo-Inertia Tensors 

Using the notation of Reference 1 (see equation 53 or Reference 2, equation 98), 
T, = S iR ‘ 

«s T1 = SI * (VI • V2 * 1 - VI V2) 

= SUEOP (V2,V1,S1) 

Subroutine SUEOP makes use of the scalar SI and the elements stored in 

two arrays VI and V2 to compute the components of the tensor T1 (see Utility 

Routines/SUEOP). 
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• Normalize Vectors 


V 2 =' 


V 3 X V 1 

v 3 X 1 t i 


V2 = NORM (V3 X VI) 


Goddard Space Flight Center 

National Aeronautics and Space Administration 
Greenbelt, Maryland December 1977 


(IV IV - i * tv - IV)* 12 =. {T 
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APPENDIX A 


PROGRAM LISTING FOR N-BOD2 



onr>nnnnnnnnnnnr»nnnrinnr>nor»rtr»nnnrinnr>nr)r>nnnnnn 


c 

c 

c 

c*** 

c 

c 

c 

c 

c 

L 

c 

c 

c 


c 

c 

c 

c 


**»*»*S.H*»*«*»*«»»»*»**»4 MAIN ********************************** 

N-B0C2 

A FRCGRAM TU COMPETE THE RELATIVE ATTITUDE DYNAMICS OF 
N-COUFLED FLEXIBLE EOCIES. RIGID BODIES, POINT 

masses and n symmetfic wheels 

A CCNSISTANT set CF UNITS MUST BE USED To define input data 
These UNITS ARE ASSUMEC ccnsistant and will be used in a 
ccnsistant manner throughout the computation 

NC INTERNALLY coded conversion of units is needed or provided 
references: 

NASA TN 0-7767 'A V EC T C R -D Y A D I C DEVELOPEMENT UF THE EUUATICNS 
OF motion for N-COUPLED RIGID BODIES ano 
POINT MASSES* 

BY HAROLD P. FRISCH OCT, 1974 

NASA TN D-8047 'A V E C T C R-D Y A DI C DEVELUPEMENT UF THE EQUATIONS 
OF MOTION FOR N- COUPLED FLEXIDLE BODIES AND 
POINT MASSES' 

BY HAROLD F. FRISCH AUG, 1975 

IN FFEFERAT ION * T HE N-E0C2 USER’S AND PROGRAMMERS MANUEL* 

BY HAROLD F. FRISCH SUBMITTED TU EDITORIAL 12/3/77 


N— 60 0 2 IS DIMENSIONED TO ACCEPT A MAXIMUM OF 

N - BCCIES (FLEXIBLE BODIES RIGIO BODIES ♦ POINT MASSES) 

N - SYMMETRIC WHEELS 

2 N - FLEXIBLE MODES OF VIBRATION (TOTAL FOR ALL FLEXIBLE BOCIES) 
4N - MCCAL C R CSS -CO UP L I NG COEFFICIENTS (TOTAL) 

32 - INDEPENDENT CEGREES OF FREEDOM 
160 - FIRST ORDER NON-LINEAR DIFFERENTIAL EQUATIONS 

THIS VERSION OF N-BCC2 LSES 
N = 10 

MAKING LSE UF N.LT.10 SAVES CONSIDERABLE COMPUTER STORAGE 

N.GT.10 RUN TIME FOR PRATICAL APPLICATION EXCESSIVE 


symbol 

LIST ABBREVIATIONS 



IOEMS - N*»2 

♦ N 

1 ♦ 1 - ( N* (N-l ) )/2 


lDEMj = ( N— 1 

) * *2 

♦ N - ( 

( IS - i ) * ( N- 

-2) )/2 


IDEM* = SIZE 

CF 

/LCGIC/ 

16 

LOGICAL 

WORDS 

IDEM s = SIZE 

OF 

/ INTG/ 

7 24 

INTEGER 

WORDS 

IDEMf = size 

CF 

/ INTGZ/ 

70 

INTEGER 

WORDS 

IOEM7 - SIZE 

CF 

/REAL/ 

4354 

REAL WORDS 

ICEMe = SIZE 

OF 

/REALZ/ 

166 

REAL WORDS 

10 E MS = SIZE 

OF 

/SATELL/ 

1000 

REAL WORDS . 

ALL CCMFLTEO 

VECTORS ANC 

TE fsSUKS 

IN computing frame 

NA = UP T IUN 

NO T 

AVAILABLE IN N-BJD2 


» = NUMBER OF 






COORDINATES 


CO 100000 
CO 100100 
CO 100200 
* CO 100300 
CO 100400 
CO 100500 
CO 100600 
CO 1C0700 
CO 100800 
C 0 1 00900 
00 101 000 
CO 101 100 
00101200 
CO 101300 
C0101400 
CO 101500 
CO 101600 
CO 101700 
CO I Cl 800 
CO 101900 
CO 102000 
CO 102100 
, CO 102200 
CO 102300 
CO 102400 
CO 102500 
CO 102600 
CO 102700 
CO 10280C 
CO 102900 
CO 1 03000 
CO 103100 
CO 103200 
CO 103300 
CO 103400 
CO 103500 
CO 103600 
CO 103700 
CO 103800 
CO 1 03900 
CC 1 04000 
CO 104100 
CO 104200 
CO 104300 
CO 104400 
CO 104500 
CO 104600 
CO 104700 
CO 104800 
CO 104900 
CO 105000 
C01C5100 
CO 105200 
CO 105300 
CO 1 05400 
CO 1 05500 
CO 1 05600 
00 1C5700 
C 0 I 0 5 80 0 
CO 105900 


A-3 


Preceding Page Blank 



a n 


c 

c 

c 

c 

c 

c 


c 
c 
c 
c 
c 
c 
-,-C 
c 
c 
c 
.c 
,c 
. c 
- c 
c 
c 
c 
c 
c ■ 
c 
c 


ei=C = BCCY FIXED COORDINATES 

CFC = COMPUTING FRAME FIXED COORDINATES ( BOCY 1 OR INERTIAL) 
IF C = I NER T I ALLY FIXED CCORCINATES 
EOIV(XMN) = EQUIVALENCED TO XMN ARRAY 

CSN = 6 Y USE OF A GUMMY VARIABLE SUBSCRIPT 0 ALLOWABLE 


NAME 


SYMBOL LIST AND -STORAGE LOCATION 
TYPE DIMENSION STORAGE DEFINITION AND SUBROUTINE USEC IN 


ANGC 
AwORK 
C A 
C AC 
C AC 

C SDUM ,CE 
CECCUM . CdC 
CEN 
CLM 
. CNF 
C CM C 
CT1 
C T 2 
CT3 
CT4 
CT5 
DCMC 
DUMMY 
ETC 


c . 

ET IC 

.. c 

ETM 

c 

E7MC 

c 

FCF 

0 C 

FCK 

• c 

FCCN 

c 

FG1 

. c 

FG2 

c 

FG3 

c 

FG4 

c 

FG5 

. c 

FLA 

, c ' 

FLAC 

• c 

flb 

c 

FLC 

c 

FLCfiC 

c . 

FLD 

c 

FLE 

■ c . 

FLF 

C • 

F L I fiC 

C. - 

flj 

c 

FLO 

c 

FLCC 

. C • 

flc.v 

0 'OF *■ 

F CMC 

c 

GAM 

c 

H 

c 

HM 

' c 

HMC 

e 

FMCM 

c 

ICEM4 


R 3 ( N + 1 ) 

I 20C 
fi 0 .N 
fi 3 «N 
fi 3.N 
fi 3 «o:n 
fi 3 .c:n 
fi 3 
fi N 
fi 3 • N 
fi 3 * N ♦ i 
I 
I 
I 
I 
I 

fi 3 .N+l 
fi 1 OCO 
fi 3 • N 1 
fi 3 * N 
fi 33 
fi 3 »N 
fi 3 .3 »4N 
fi 3.4N 
I 3 ( fs ♦ 1 ) 

L 

L 

t_ 

L 

L 

fi 3 . 2 N 
fi 3 . 2N 
fi 3 • 2N 
fi 3 »2N 
fi 3 .N 
fi 3.3 *2N 
fi 3.3. 2N 
fi 3.3 . 2N 
fi 3 • N 
fi 3.3.2N 
fi ' 3.2N ‘ 

fi 3.2N 
fi 2 N 

fi l™ iQ ' 

fi 3 . I DEM 2 
fi 

fi 3 .N 
fi 3 . N 
fi N 
I 


EGI V{ XMN ) 

/ I N TG / 
/fiE^L/ 
/REAL/ 
/REAL/ 

/RE AL Z/ 
/fiEALZ/ 
/REAL Z/ 
/REAL/ 

EC I V( XMN ) 
/REAL/ 

/ IN1G/ 

/ IN1G/ 

/ I N 7G / 

/ IN TG/ 

/ I NTG/ 

/REAL/ 

/SATELL/ 

/REAL/ 

ECIVOMN) 

/fiE AL/ 

EQlV(XMN) 

/REAL/ 

/REAL/ 

/ 1 N TG/ 

/LCGIC/ 

/LOGIC/ 

/LCGIC/ 

/LOGIC/ 

/LOGIC/ 

/fiE AL/ 
/REAL/ 

/RE AL/ 
/REAL/ 
/REAL/ 

/RE AL/ 

EC l V <FLD) 

EGI VIFL J ) 

/RE AL/ 

/REAL/' 

EGIV(FLE) 

/REAL/ 

/REAL/ 

/RE a l c /° u 01 
/REAL/ 

/RE AL/ 

/RE AL/ 

/RE AL/ 
/REAL/ 
LOCAL 


EULER ANGLE COT ( ANGLE , SETUP 1 
LOCAL WORK AREA TO SAVE STORAGE 
CM VECTOR BFC (INBS) 

CM VECTOR CFC I V D I V , T RAN VD > 

ZERO DEF CM VECT BFC (VCIV) 

HINGE VECTOR BFC l INBS) 

HINGE VECTOR CFC I VC I V. TR AN VD ) 
HINGE VECTOR PART (INBS) 

SCALAR TOROUE ON WHEEL (TORQUE) 
FORCE CENTRIPETAL ♦ COR I OL I S < E T A ) 
ANG RATE TO COMP FRAME (RATE.CCT) 
COUNTER (INCPT) UNUSED AFTER 
COUNTER (INCPT) UNUSED AFTER 
COUNTER (INCPT) UNUSED AFTER 
COUNTER (INCPT)wPASSES THRU (CYN) 
CUUNTER (INUPT) UNUSED AFTER 
PART OF ANG. ACC. VEC. (RATE) 
STORAGE AREA FOR USER 
GYRCwEXT.TORQ.ON NEST (ETA.QFCOT) 

inert x-coup turq. (eta) 

SCALAR .GENEALIZED TORQUES (QFCOT) 
WHEEL X-COUP TURQ. (ETA) 

MODAL CENTRIP X-C UUP ( INOPT , QFCCT ) . 
MODAL CORIOLIS X-COUP ( I NOPT , QFDOT ) 
CODE .FREE' VECTORS (INBS) 

END OF RUN FLAG ( M A I N , D YN .OUTPSP ) 
ERROR INPUT CATAIMAIN. INEROR) 

ERROR INPUT DAT A( MA IN , I NOPT ) 

UNUSED 

OUTPUT DATA 7 FLAG ( M A I N , TO R Q LE ) 
MOCAL CM VECTOR OFC (INOPT) 

MODAL CM VECTOR CFC ( VD I V . T R AN V C ) 

mocal Moment vector bfc (inopti 

MOOAc ROTATION MOMENT BFC (INCPT) 
GYRO FLEXIBLITY FORCE (ETA) 

MODAL INERTIA OYAD BFC, (INOPT) 

FLO + FLOW* T IVOIV) 

FLO w FLH ( VCIV) ‘ ' 

GYRO FLEXIBLITY TORQUE (ETA) 

MODAL R CT AT ION dVaD^BFC (IJJOPT) 
MODAL MOMENTUM V EcVo'fL 'bjF C ’ ,( V C I V ) 
FLO IN CFC (VDI vVtRAiNVd') 

MOCAL FREQUENCY '('I NOPT') 

‘tN’ERTl AL J 
HINGE TO CM VECTOR (VDI V. XDY ) 
INTEGRATION STEP SI ZE . ( RUNG E • INES ) 
WHEEL SPIN AXIS BFC (INBS) 

WHEEL SPIN AXIS CFC ( VDIV.TRANVD) 
WHEEL ANGULAR MOMENTUM ( I N BS . S ET UP ) 
SIZE OF /LUGIC/ ( RST ART ) 


VECTOR ,I.HATE J ) 


CO 106000 
C C 1 061 00 
CO 106200 
CO 106300 
CO 106400 
CO 106500 
CO 1 06600 
CO 106700 
CO 106B00 
CO 1 06900 
CO 1 07000 
CO 1 07 1 00 
C0I07200 
CO 107300 
CO 107400 
CO 107500 
CC1C7600 
CO 107700 
CO 10 7000 
C01C7900 
CO 108000 
CO 108100 
00 108200 
CO 108300 
CO 108400 

co loesoo 

CO 10 860 0 
CO 108700 
CO 1C8B00 
CO 108900 
C C l 09000 
CO 109100 
CO 109200 
CO 109300 
00109400 
C 0 10950 0 
CO 109600 
CO 109700 
CO 1 09800 
CO 109900 
COll 0000 
C0110100 
C 0 11 020 0 
CO 1 10300 
CO 11 0400 
COll 0500 
CO 1,1 0600 
CO 1,1 07C0 

CO. 1 1 0800 

CP. U 0 900 
CO 11 1 00 0 
COll 1 100 
.COll 1200 
COll 1300 
COll 1400 
COll 1500 
COll 1600 
CO 11 1 700 
COll 1800 
CO 11 1 900 


-A-4 



c 

I CE fr 5 



LOCAL 

SIZE OF /INTG/ (RSTART) 

00112000 

c 

ICEX6 



LOCAL 

SIZE OF /INTGZ/ (RSTART) 

C01I2100 

c 

I CEM7 

1 


LOCAL 

SIZE OF /REAL/ (RSTART) 

CC1I 2200 

c 

ICEA8 



LOCAL 

SIZE OF /REALZ/ (RSTART) 

COll 2300 

c 

ICEA9 

X 


LOCAL 

SIZE OF /SA T ELL/ ( R ST ART ) 

CO 112400 

c 

1 IN IT 

1 

IDEM5 

EC I \l AWORK) £EKO OUT / I NTG/ (RSTART) 

COll 2500 

c 

I NEFF 

L 


/LOGIC/ 

FLAG.BFC OR IFC FOR CFC (INOPT) 

CO 11 2600 

c 

I2INIT 

X 

IDEM6 

ECI V ( SCNDuM) ZERO OUT /INTGZ/ (RSTART) 

CO 11 2700 

c 

JCCN 

I 

N 

/ IN'IG/ 

BUOY CONNECTION MATRIX ( INBS ) 

CO 112800 

c 

L CO N 

X 

2(N+1 ) 

/ I NTG / 

CODE. LOCKED VECTORS (INBS) 

CO 11 2900 

c 

L ANGLE 

L 


/LCEBUG/ 

PRINT EQUATIONS IN ANGLE? (MAIN) 

COll 3000 

c 

l'cc t 

L 


/LOEBOG/ 

PRINT ECOATIONS IN DC T? (MAIN) 

COll 3100 

c 

LEU 

' L 


EC I V < ) 

EQ I V IN EACH SOB TO PRINT FLAG 

COll 3200 

c 

lequi v 

L 


/LOEeUG/ 

PRINT ECUATICNS IN EQIV? (MAIN) 

COll 3300 

c 

LETI 

L 


/LOEBOG/ 

PRINT ECUATICNS IN ETA? (MAIN) 

COll 3400 

c 

LIN IT 

L 

I DEM4 

ECI VIFGI I 

ZERO OUT /LOGIC/ (RSTART) 

00 11 3500 

c 

L QF COT 

L 


/LDEEUG/ 

PRINT EQUATIONS IN QFDOT? (MAIN) 

CO 1 1 3600 

c 

URATE 

L 


/LOEBOG/ 

PRINT ECUATICNS IN RATE? (MAIN) 

CO 113700 

c 

LRTAPE 

. L 


/CFEKS/ . 

CREATE RESTART TAPE? (MAIN) 

CO 113800 

c 

L BUNGE 

L 


/LCEBUG/ 

PRINT EQUATIONS IN RUNGE? (MAIN) 

COll 3900 

c 

LSETUF 

L 


/LOEBOG/ 

PRINT EQUATIONS IN SETUP? (MAIN) 

C01I4000 

c 

LSI MQ. 

L 


/LDEBOG/ 

PRINT EQUATIONS IN S I MQ ? (MAIN) 

CO 114 100 

c 

ltcrqu 

L 


/LOEBOG/ 

PRINT EQUATIONS IN TORQUE? (MAIN) 

CO 11 4200 

c 

ltr an 

L 


/LDEBUC-/ 

PRINT EQUATIONS IN TRAN? (MAIN) 

‘C0414300 

c 

LTR AN V 

L 


/LOfcBUG/ 

PRINT EQUATIONS IN TRANVD? (MAIN) 

00114400 

c . 

ltrns i 

L 


/LOEBOG/ 

PRINT EQUATIONS IN TRNSIV? (MAIN) 

CO 11 4500 

c 

LV01V 

L 


/LOEBOG/ 

PRINT EQUATIONS IN VOIV? (MAIN) 

COll 4600 

c 

L'xdv 

L. 


/LOEBOG/ 

PRINT EQUATIONS IN XDY? (MAIN) 

CO 1 1 4700 

c 

mc 

X 

N 

/.INTC-/ 

BODY IN WHICH WHEEL IS IN (INES) 

COll 4800 

c 

NECC 

.1 


/IMG/ 

NUMBER OF BODIES (INBS) 

COll 4900 

c 

NE 1 

I 


/INTO/ 

NUMBER OF BODIES ♦ 1 (INBS) 

CO 1 15000 

c 

NCTC 

l 

; 

/ IN TG/ 

( INOPT, NA) CONSTRAINT TORQUES 

CO 11 5100 

c 

NEQ 

I 


LOC AL 

* EQUATIONS SETUP BY N-BOC2 ( EQ I V ) CO 1 1 5200 

c 

NFER 

I 


/IN TG/ 

* FREE COORD VECTORS (INBS) 

CO 11 5300 

c 

NFKC 

I 


/.I NTG/ 

(INOPTiNA) CONSTRAINT FORCES 

COll 5400 

c 

NFL XB 

I 


/I NTG/ 

0 FLEXIBLE BODIES (INOPT) 

COll 550 0 

c 

NFRC 

X 


/IMG/ , . 

0 RELATIVE ANGLES COMPUTED ( I NOP T ) CO 1 1 5600 

c 

NLOR 

I 


/ I N T G / 

•LOCKED COCRD VE CTOR S ( INBS ) 

COll 5700 

c 

NFC 

i 


/IMG/ 

TOTAL NUMBER CF WHEELS (INBS) 

CC 11 5800 

c 

NFO A 

i 


/IMG/ 

0 WHEELS TO COMP REL ANGLE ( I NOPT ) 00 1 1 5900 

c 

NFCCS 

i 


/ INTG/ : 

TOTAL 0 MODES FOR SYSTEM (INOPT) 

COll 6000 

c 

NF V 

i 


/ IN TG/ 

•VARIABLE SPEED WHEELS (INOPT) 

C0116100 

c 

N STAR T 

L 


/CFEKS/ 

NEW CR RESTART RUN? (MAIN) 

CO 116200 

c . 

nsvp 

I 


/IMG/ 

* LOCKEO VECTORS TRANSF ORM( VC I V ) 

CO 1 1 6300 

c 

NSVC 

X 


/INTG/ 

0 FREE VECTORS TRANSFORM (VCIV) 

CO 116400 

c 

N TO 

I 


/IMG/ 

• DIFF EQS.IN SUB TORQUE (TORQUE) 

COll 6500 

c 

PCGN 

I 

NT 1 

/I NTG/ 

• CONSTRAINED AXES AT HINGES ( INeS 

ICO 116600 

c 

PH 

R 

3.N+1 

/REAL/ 

EXTERNAL TORQUE CN NEST (TORQUE) 

CO 11 6700 

c 

plm 

R 

N 

/RE AL/ 

WHEEL SPIN INERTIA (INBS) 

COll 6800 

c 

, CF 

R 

3 ,3<N* 1 I 

/REAL/ 

FREE VECTOR ,BFC ( INBS.)', . 

00.116900 

c 

. CFC 

fi 

3 . 3.1 N ♦ 1 ) 

/REAL/ 

.FREE VECTOR CFC ( VDIV .TRANVD ) 

COll 7000 

c 

CL 

R 

3 , 2 ( NT 1 ) 

/REAL/ 

LOCKED VECTOR OF C (INBS) 

CO 11 7100 

c 

OLC 

R 

3 , 2 ( NT 1 ) 

/REAL/ 

. LOCKED VECTCR CFC (VDIV, TRAN VC ) 

CO 1 1 7 200 

c 

RELC 

L 

• V/ 

/LO,GI C/ v 

,, f-UGIC BOpY A OR % POI NT ( .RASjS? .(INBS) 

COll 7300 

c 

R IN IT 

*?‘ 

IDEM7 

EOI V(CA) 

ZERO OUT /REAL/ (RSTART) 

COll 7400 

c 

RCFC 

R- 

3 ,NT1 

/REAL/ 

RELATIVE RATE VECTOR CRATE) 

COll 7500 

c 

R2IMT 

R 

IDE MB 

EQ I V ( CeCUM) ZERC OUT /REALZ/ (RSTART) 

CO II 7 600 

c 

SC 

1 

3IN+1 | 

/ INTG/ 

FREE VECTORS CAGED ( I NOPT .UNCAGE ) 

CO 11 7700 

c 

see 

I 

N 

/ I N T G/ 

UNUSED 

COll 7800 

c 

SCG 

I 


/IMG/ 

0 CAGED DEGREES ( I NOPT , UNC A G E ) 

COll 7900 
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c 

SCNCU* , SCN 

I 

0 : N-i 

/INTGZ/ 

c 

SCWCU^.SCft 

I 

o :n- i 

/INTG Z/ 

c. 

SC X c 

I 

2N 

EC I V ( TCRQ) 

c 

sc 

I 


/INTG/ 

c 

SE U 

I 


/IMG/ 

c 

SFCC 

I 


/IMG/ 

c 

SFKCUM • SFK 

I 

o :n-i 

/ 1 N TGZ/ 

c 

SFL X 

I 


/ IN IG/ 

c 

SFR 

I 

3CN+1 ) 

/INTG/ 

c 

S F X N 

I 

N 

/INTG/ 

c 

sc- 

I 


/IMG/ 

c 

S I 

I 

I DE M3 

/INTG/ 

c 

SI 6 

I 


/IMG/ 

c 

■S 3XCUM. SIX 

I 

0 :n- 1 

/ 1 N TGZ/ 

c . 

SKDLiM • SK 

I 

o :n-i 

/ I N TGZ / 

c 

SL 

I 


/INTG/ 

c 

SLK 

1 

3 ( N ♦ i ) 

/INTG/ 

c 

SMA 

I 

N 

/INTG/ 

c 

SMAL 

1 


/IMG/ 

c 

SMCCUM • SMC 

i 

o :n-i 

/ IN TGZ/ 

c 

SFV 

I 


/INTG/ 

c 

SCK 

1 

Nil 

/INTG/ 

c 

SP I CUM • SP I 

I 

0 IN-i 

/IN TGZ/ 

c 

S CF 

1 

N ♦ l 

/IMG/ 

c 

SQL 


N + l 

/INTG/ 

c 

SP * 

1 


/INTG/ 

c 

S SC K 

1 


/IMG/ 

c 

ss i x 

I 


/IMG/ 

c 

S VA 

I 


/INTG/ 

c 

sve 

I 


/INTG/ 

c 

S VD 

I 


/INTG/ 

c 

SVi 

X 


/IMG/ 

c . 

S VM 

I 


/INTG/ 

c. 

SVP 

I 

2 (N+I ) 

/INTG/ 

c>v 

SVQ 

I 

3 (N+i ) 

/INTG/ 

c 

S XM 

I 

3 .N 

/INTG/ 

c 

S XT 

I 


/INTG/ 

c 

T 

P 


/REAL/ 

c 

TEM 

P 

2 . 1 eo 

LCC al 

c 

TFA •' 

P 

33 

/REAL/ 

c 

7 F AC 

P 

33 

/RE AL/ 

c 

T F A CD 

P 

33 

EQIV(ETM) 

c 

TFACfc 

P 

N 

/RE AL/ 

c 

TFA* 

P 

N 

/REAL/ 

c 

T I* END 

P 


/RE AL/ 

c 

TCP C 

I 

v7 

/INTO/ 

c 

T LG 

P 

3 <N+ l ) 

/REAL/ 

c 

XC IC 

P 

3.3# IDEM2 

/REAL/ 

c 

X I 

R 

3 .3 .N 

/RE AL/ 

c 

XIC 

P 

3 • 3 . N 

/REAL/ 

G :,n 

X 10, f - 

P. 

3 . 3 .N 

/RE AL/ 

c ’ 

XMAS ‘ 

P 

N 

/RE AL/ 

c . 

XMCCUM , XM C 

P 

3 .3 . C : N 

/REAL Z/ 

c_ 

xmn. J 

P 

33.33 

/RE AL/ 

C ~ 

Y 

P 

I 60 

LOC AL 

c 

YC 

P 

1 tO 

LOCAL 

c 

YMCC ' 

R 

3.2 .N4- l 

EC I V ( XMN ) 

C 

XMT 

P 

3 . 3 .N 

/REAL/ 

c . 

ZE T A 

P 

2 N 

/PE AL/ 


c 


COOE. CENTRIPETAL EFFECTS (INOPT) COlieCOO 
CODE .CORIOL IS EFFECTS (INOPT)- C01I8100 

CODE ,X -COUP MODES ( I NOPT . OF COT ) C01ie200 

CODE, DIRECTION COSINES (INOPT) C0118300 

CODE, EULER ANGLES (INOPT) C0118400 

CODE , dUU I ES FLEX X-CUUPLING ( INOPT CO ll 8500 
CODE .CONSTRAINT FCRCE ( INOPT . N A ) C0118600 

CODE. ALL FLEXIBLE BODIES (INOPT) C011E700 
COOE, COMPUTE FREE VEC ANGLE ( I NOP T ) 00 l 1 8800 
» MODES EACH BOOT (INOPT) CC 11 8900 

CODE. ALL GYRCSTATS(SETS) C0119000 

CODE. BODIES HINGE TO CM (SETS) C0119100 

UNUSED CO 1 1 9200 

CODE, INERTIA EFFECTS (INOPT) C9119300 

CODE. BODIES IN EACH NEST (SETS) C0119AO0 
CODE. ALL POINT MASSES (SETS) C01I9500 

CODE. CONSTRAINT TORQUE( INOPT ,NA ) C0119600 

CODE . MHEEL ANGLE COMPUTE ( INOPT )•' C0119700 

CODE .SMALL ANGLES (INOPT) C0119800 V 

CODE. ALL aHEELS IN NEST (INOPT) 00119900 
CODE. VARIABLE SPEED W HEEL S ( I NOP T ) C 0 12 0C00 
CODE, BODIES HINGE 0 - CM (VDIV) ' C0120100 

CUDE.PSUEDO INERTIA T ENSORS ( I NOP T ) CO 12 0200 
CODE. FREE VECTOR AT HINGE (SETS) C012C30C 
CODE, LOCKED VECTOR AT HINGE ( SE TS ) CO I20AOO ’ 
CODE, ALL RIGID BODIES (SETS) COI20500 

CODE. UNION CF ALL SCN (VDIV) C0120600 

CODE, UNION CF ALL SIX (VDIV). C01207C0 

CODE. CM VECTORS TRANSFORM (VCIV) C012080C 
CODE .HI NGE VECTORS TR ANSFGRM ( VC I V > CO 12090C 
CODE. DON'T TRANSFORM (INOPT) C0121000 

CODE, INERTIA D V A D TRANSFORM ( VD I V ) 0 0 12 I 1 00 
CODE. SPIN VECTORS TR ANSF ORM ( V C I V ) C0I2I200 

CUDE.LJCkED VECTORS TRANSFORM (VC IV CO 12 1 300 
CODE. FREE VECTORS' T R ANFCRM ( V C I V ) C0121AOO 
CODE. SMALL ANGLE K I NE M AT I CS ( I NOP T ) CO 12 1 500 ; 
CODE. TIME VARY COL INER MAT ( I NOP T ) 00 12 1 600 
TIME (MAIN) C0121700 

TEMP STORAGE AREA (RUNG!) C0121800 

GENEALIZEC COORDINATES! INBS . SETOP ) CO 12 1 90 C 
GENERALIZE COORD RATE ( I N E S , S E T UP ) C 0 1 22 OOC 
GENERALIZE COURD ACC (SETUP, SIMQ) C0122IOO 
*HEEL RATE (INBS. SETUP) C0122200 

AHEEL A NGLE (IN8S, SETUP) •' COI22300- 

TIME TO END RUN (IN8S.DYN) C0122400 

UNUSEO STORAGE AREA FOR USER CO 122500 

TIME TC UNCAGE ( INOPT .UNCAGE ) COI22600 

MATRIX OF INERTIA T ENSOR S ( V C I V , X C Y C 0 1 2 2 700 
INERTIA DYAC. BFC (INBS) C0122800 

INERTIA DYAC :CFC ( V D I V , T R AN V C ) C0122900. 

ZERO INERTIA DYAD BFC(VCIV) i - - - C0I23000- 
BUDY MASS (INBS) . C012310C 

TRANSFORM BFC TO CFC ( TRNS I V . TR AN ) 00 123200 
SCALAR INERTI-A ! flATR IX ( VD I V DC' T ) C 0 1 233 0 0 -j 

SYSTEM STATE ( E U I V . SE TUP . TORQUE ) C0123400 

SYSTEM STATE DERIV ( SE TUP . TOR OU E ) CO 123500 
DIRECTION CCSINE RATES ( DCT ) C0123600 

ZERO STATE TR A NSFOR MT ION M A T ( INE S ) 00 12 3700 
MOCAL DAMPING RATIO (INOPT) C0123800 

CO 123900 


n a 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c • 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c. 

c 

c 

c 

t 

c 

c 


c. 

c 

c 

c 

c 


•3LERUUTINE LOCATION 


FAIN 

CYN 

FSTAfiT , 
1NSS 
INEFCF 
SETS 
INJF T 
INTCF 
IF NS IV 
VC I V 
EQI V 
TRAN 
TRAN VC 
FATE 
>CY<. 

ETA 

TCfiUUE, ' 

CFDG.T 

CCT 

ANGLE 

SETUP 

CUTPLT 

CUTPSP 

S IMC 

FUNCE 

LNC ACE 

CCMFFS 

LNPMS 

CCMFAC 

LNPAC 


OOCCO 100 
0C2C0C00 
003CCC00 
.00400000 
0C5C0CC0 
C06C0C00 
OC 7C0C00 
COSCOCOO 
00900000 

oi ococoo 
Oil cocoo 
01 200000 
013C0C00 
01 4CCCC0 
0 1 5C0C00 

c i bcccoo 

Cl 7CCCOO 

oiacccco 

C 1 9C0C00 
C20C0000 
02 1 CCCCO 
022 COCOO 
023CCC0O 
024CCC00 
02SC0CC0 
0 26 CO COO 
026 02 60 C 
026 CS 100 
026C6tC0 
026C9 100 


C ■ . KTO 

C - KT1 

C , C T A I N 

c’’. VECTFN 

C ' 1ENTRN 

C ' VECNFM 

C FATFLL 

C ’ 1FN.SFS 

C- , ■ POT' 

c; VECACO 

C VECSLH 

C SCLV 

C : VECCCT 

C' VECFCS 

C .. T R I P VP 

C C Y ADC 

C ■ SCLC, 

C ' ■ • CYDCTV ' 

C V AD Y CV 

C CYTCV 

C •• ' VGDY6V ' 

C C YQP 

C SUECP 

C CUTF.U. 

C ’ CLATCP 

C . THANSU 


02612200 
026 1 3COO 
02613600. 
C27COCCO 
027C2C00 
C2704600 
027C6 100 
C27C7400 
027C66C0 ■ 
02800000 
028C 1 CCO 
028C 1900 
028C2600 
028C3SOO 
028C4400 
028C6CC0 
C28C7CC0 ; 
J . I i •-c28Ce SOO 
02 8 C9tC 0 
* ‘ 028 1 1 COO 

« • a ; >'0 23 12400^ 
02813900 
02815400 
C29COCOO 
029C2200 
029C3300 • 




C 0 12 4000 
C0124100 
CO 124200 
CO 124300 
CO 124400 
CO 124500 
C012460C 
CO 12 4 7 00 
C 0 12 4800 
C 0 124900 
C 0 125000 
C0125100 
CO 125200 
C 0 1 2 5300 
C 0 12 540 0 
CO 125500 
CO 125600 
CO 12 57 00 
CO 125800 
CO 125900 
C 0 126000 
CO 1 26 100 
CO 126200 
^ 0126300 
CO 126400 
CO 126500 
CO 126609 
CO 126700 
CO 126800 
CO 126900 
C0127000 
CO 127100 
CO 127200 
CO 127300 
CO 127400 
CO 127500'' 
CO 127600 
C0127700 
CO 127800 
CO 127900 
CO 128000 
C01281 00 
CO 128200 
CO 128300 
C 0 12 8400 
CO 128500 
CO 12860 0 
CO 128700 
CO 128800 
CO 128900 
CC 129000 
CO 1291 00 
CO 129200 
CO 129300 
CO 129400' 
C 0 12 9500 
CO 129600 
CO 129700 
C 0 129800 
CC 129900 
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implicit keal» a( A . Q-Z . 1 ) 

LOGICAL FG1 . FG2, FG3 . PGA • 


LOGICAL 
LOGI CAL 


INERF, RtSLC. LEGU. LlNlT(l| 

MTART , LRTAPc 

LRLNGE • LTRNS1 . LVUIV , LEUU1V , L TRAN , 
LTFANV . LRATE . LCOY , LETA , LTGkCU , 

LANGLE 


LCFOOT 


LCCT 


L SETUP 


LSI MO 


IN TECEN 


CO 130000 
CO 130100 
CO 130200 
CO 130300 
CO 13040C 
CO 1310500 
CO 130600 
CO 130700 
C 0 130800 
CO 130900 
C013100C 


* 

AUCRK 


CT1 


CT2 , 

C T 3 

» 

CT4 


CT5 

F CON 

9 

PCON 

* 

CO 131 100 

* 

SCNCUM 


SCN 


SCRDUM . 

SCR 

• 

sfkdum 


SFK , 

SFR 

• 

SG 

* 

CO 131200 

♦ 

S I 


S It* 


£ I XDUM. 

SI X 

• 

SKDUM 


SK • 

SL 

• 

SL K 

* 

CO 131300 

* 

SMA 


SMCDUy 


SMC . 

SM V 

• 

SDK 


SP I DUM • 

SPI 

* 

SOF 

• 

C C 1 3 1 400 

* 

SCL 


SR 


£ SCN . 

S £ I x 

• 

S V A 


sv e . 

svo 

• 

SV I 

* 

CO 1 31 500 

* 

SVM 


SVP 


SVQ , 

S X M 

* 

SXT 


TURQ • 

SMAL 

• 

SEU 

• 

CO 131600 

* 

sc 


SCO 


NFLXB . 

SFLX 

* 

SFX M 


NMCDS • 

SFCC 

• 

sec 

* 

CO 13 1 70C 

* 

I IN IT( 1 ) 



IZINITl 1) 

9 

SO 


SCXCf 20) 





C013180C 


pea L*e 

* ANGC (23) 

* FLO (2.20) 

* TPACO (23) 


CCMMCN /CHENS/ 


CNF 

FLE 

VMCD 


(2.10 . ET IC 

(2.3 .20 ) , FLH 


(3,10) , E T MC 

(3,3,20), 


(3.10) 


(3.2,11). RINIT (1) 


CCMMCN /LuEdUG/ LfiLNGE 
> LTfiANV 


NSTART. LRTAPE 


LTFNSI . LVOIV 

LR ATE , LXDY 


LCFDGT . LOCI 


. LANGLE . 


REIN IT ( 1 ) 


LEUU I V , LTRAN 
LETA . LTOROU 
L SE TUP , LSIMU 


C 0 1 3 1 900 
CO 132000 
C0132I00 
CO 132200 
CO 132300 
CO 132400 
CO 132500 
CO 132600 
C0132700 
CO 132800 
CO 132900 
CC 133000 
CO 133100 
CO 133200 



CCWMCN 

/LUGI C/ 

FG l . FG2 

• • F G 3 • F G 4 * -F G S 

. INERF. 

RBLOt 10) 


CC 133300 











CO 133400 











CO 133500 

COMMON 

/ IN TG / 


A WORK 

(200 1 

• 




CC 13360C 

♦ 

Cl l 


• 

CT2 


* C T 3 


• CT4 


,. CO 1 33700 

* 

C T 5 


• 

F C ON 

( 23) 

• J CO N 

( 10 ) 

t LCUN 

( 22 ) 

. CO l 3 3 80 0 

* 

MC 

( 10) 

» 

NH1 


• N60D 


• NCTC 


. CO) 3390 C 

* 

NFES 


• 

NF KC 


• nfrc 


• NLOR 


, C0134000 


N M V 


• 

NMC 


• NMOA 


• N S VP 


, CO 134 10 0 

♦ 

NSVC 


• 

FCON . 

< 11 ) 

. SO 


t SF R 

(33 ) 

. CO 134200 

* 

SG 


* 

S I 

( £5) 

• SIG 


. SL 


, CO 134300 

* 

SLK 

( 23) 

• 

SMA 

(10) 

* SGK 

(11) 

t SQF 

(11) 

, CO 134400 

*• 

SCL 

(11) 

• 

SM V 


• SR 


. SSCN 


. CO 1 34 50 0 

* 

S S I X 


• 

S VA 


• SVd 


* SVD 


, CO 134600 

♦ 

SV I 


• 

SVM 


• SVP 

(22 ) 

. SVO 

(33) 

. C 0 1347 00 

♦ 

S XM 

(2.10) 

• 

S XT 


• TORQ 

(97) 

. SMAL 


. C 0 134800 

* 

SEU 


9 

MO 


# SC 

( 33 > 

. SCG 


. C 0 1 34 90 C 

* 

NFL > d 


9 

sflx 

.. ... 

• SF XM 

(10) 

• NMQDS 


. CO 135000 


SFCC 


9 

see 

( 10 * - 


, 


- 

. C0135100 


• 

CCMMCN /1NTGZ/ 


J 4 A i 


»* # v D.l 

4 J ./-♦ | o 

♦ 

SCNCUM 

• SCN 

( 9 ) 

, SCRDUM 

* SCR 

( 9) 

* 

S F K C L M 

* SFK 

( S 1 

• SIXDUM 

• SIX 

(9) 

* 

skdlm 

SMCCUM 

• SK 

• SMC 

( 5 1 
( S 1 

• SPIOUM 

t SPI 

(9) 


CO 1 35 20 C 
CO 135300 
, CO 135A0C 
CO 135500 
CO 135600 
CO 135700 
CO 13580C 
CO 135900 
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CCVMCN /PEAL/ 


CO 136000 
CC 1361 00 



C A 

(3.10) 


CAC 

(3,10) 


CL M 

(10) 


CC MC 

(3.11 ) 

• 

CO 136200 


DCMC 

(3.11 ) 


ETC 

(2.11) 


e r m 

(33) 


FCMC 

(2.11 ) 

• 

CC 136300 


GAM 

(3.60) 


F 



HM 

(3.10) 


HMC 

(3.10) 

• 

C 0 1 36400 


HKC b 

( 10 ) 


FFI 

(2.11) 


PL M 

( 10 ) 


QF 

(3.22) 

• 

CO 136500 


QFC 

(3.33 ) 


QL 

( 2.22 ) 


QlrC 

(3,22 ) 


RUMC 

(2.11) 

• 

CO 136600 


T 






THA 

(331 


THAD 

( 33) 

• 

CO 136700 


T F A C W 

( 10 ) 


ThA H 

( 10 ) 


XOIC 

(3.3. 66 1 


X I 

(3.3.10 

• 

CO 136800 


x rc 

(3.3.10) 


XhAS 

(10) 


XMN 

(33,33) 


XMT 

(3.3.10 

• 

C 0 136900 


T LG 

( 23 ) 


FLA 

( 2.20 


FL. 0 

(3,20) 


FLC 

(3.20) 

• 

CO 137000 


FLO 

(3.3.20) 


FL J 

(2.3 .20 ) 


CAO 

(3.10) 


XIO 

(3.3.10) 

• 

CO 137 100 


FLI SC 

(2.10) 


FLC RC 

(3.10 


Fi_ AC 

(3.20 ) 


FL.QC 

(3.20) 

t 

CO 137200 


FLC b 

( 20 ) 


ZET A 

(20) 


F CF 

( 3.3.40 ) 


FCK 

(3.40 ) 

• 

CO 137300 


T IMEND 












CO 137400 














CC 137500 














CO 137600 


COMCN 

/PEAL // 











CO 137700 

♦ 

C0DLM 

(1.3) 

• 

CE 

(3.10) 

• 

CSCDUM ( 1 ,3) 

• 

CBC 

(3,10) 


CO 137800 

♦ 

XPCCUM( 1,1.9) 

t 

XMC 

(2.3.10) 

• 

CbN( 3 ) 






CO 137900 


/S«TELL/ AREA RESERVED FIR LSER REGUIKEl) CATA 
COPMCN /SATELL/ OLNMY(ICCC) 


EQLI VALENCE 


<ETM( 1 1, TH AO C ( 1 ) 1 
( X MN ( 1 ,3 ) . YKCC ( 1 .1 , 1 ) ) 
(XMN( 1 .8 ) . ET IC ( 1 , t > } 
(FLfcK 1.1). FLC( 1,1)1 
(FLHl 1 .1 ,1 ) .FL J< 1 . 1 . 1 1 1 
(PCI .LINITU )) 

(CtiDUW( 1 , 1 ) . P/I NI T ( 1 1) 

< SCNDUM, IZ1NIT (11) 


, (XMN (1,1), AN GO ( 11) . 

. < XMN ( 1 .6 1 , CNF ( 1 . 1 ) ) , 

. ( XMN( 1 .1 0) .ETMCC 1 . 1 1 > . 

. <FLE( 1 , 1 , 1 ) ,FLD( 1.1.11). 
* 

. (CA( l.l).RINIT(l)) . 

. ( A*URK( 1 ) . UNIT ( 1 1 ) . 

. ( T OR C ( 7 8 1 .SCXC( 1 1 ) 


CIVENSICN Y< 160) ,YC( 160 ,TEM2 ,160) 


RETURN FERE FOR START CF NEXT RUN 
1 CONTINUE 

INPUT CCNTRdL CARO 
RE AD (5 . 1 C2 .END =7 1 

' * NSTART .LRUNGE. L TRNSI ,L VO I V .CLOU I V .LTRAN ,LTR ANV .LR ATE . 

* LXO Y, LE T A , LT JROU.LOFDUT .LDCT , L ANGLE .LSE TUP .LSI NO 

♦ LfiTAPE 

LOGIC CCNTRUL PAREMETERS FOR N-80D2 
NSTART = .TRUE. A RESTART RUN AT T.NE.O 
NETART = .FALSE. ETANCARO RUN START AT T.EC'iO 
LEQU = .TRUE. PRINT EOLATIONS 
LEQL = .FALSE. BYPASS PRINTING 

' LfiTAPE = .TRUE. CO N • T CREATE A RESTART TAPE n . •. 

LRTAPc = .FALSE. CREATE A RESTART TAPE 

ZERO ALL CCMMCN ULCCKS OP FILL THEM IN FR CM THE RESTART TAPE 
CALL RSTART ( 1 . Y. YC .NEC , TEF .02 1 


CO 138000 
CO 138 100 
CO 13820C 
CO 138300 
CO 1 38 AO 0 
CO 138500 
CO 138600 
CC 13870C 
CO 138800 
CO 138900 
CO 1 3900 C 
CO 139100 
CC 139200 
CO 139300 
CO 139400 
CO 139500 
CO 139600 
CO 139700 
CO 1 3 980 0 
CO 139900 
CC 140000 
CO 1401 00 
CO 140200 
CO 140300 
CO 140400 
CO 140500 
, CO 140600 
CO 140700 
CO 140800 
C 0 14 090C 
CO 14 1 000 
CO 141 1 CO 
CO 141200 
CO 14 1300 
CO 14 1400 
C 0 1 4 1 500 
CO 14 1600 
CO 14 1700 
C0141800 
C0141900 
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C ' INPUT DESCRIPTION CF BASIC SYSTEM 

C TCPULOCV 

C INERTIA 

C KCHENTUM WHEELS 

C • ’ • GEUME TRY 

C NOMINAL STATE 

C KINEMATICAL CCNSTPAI NTS 

C • INPUT INITIAL CONDITIONS 

C KATES 

C OISPLACEMEM 

FREE COORCINATES 
' MOMENTUM WHEELS 

INTEGRATION TIME STEP 

' CALL 1NCS 

'■•'•4 CHECK FOR PHYSICALLY REALIZABLE SYSTEM 
> •.-COALL INERGR 

IF(.ncT.FUZ) CC TC 4 

'•••- ' 'FGE RESET FALSE IN INEPUP I'F PHYSICALLY UNREALI ZABLE 

•>• COMPOTE EOD Y L ABC L SETS NEE CEL) FUR SUMMATION CHAINS 
. CALL SETS 

INPUT CCMPUT AT IUN • OPT 1CNS ' 

FRAME CF CCMPUTAT ICN 

AUGMENTED SETS FOR SUMMATION TRUNCATION 
CIRECTICN CCSINE DELETION 
CLLUMNS OF INERTIA TtNSUR DELETION 
TRANSFORMATION SURPRESSIUN 
ELLER ANGLE TECHNIQUES 
SMALL ANGLE ASSUMPTIONS 
ANGULAR DISPLACEMENT. 

MOMENTUM WHEEL RATE 
MOMENTUM WHEEL ANCLE 
FLEXIBLE BOGIES 

MODAL COUPLING • 

CAGED DEGREES OF FREEOOM 
CALL INCPT 

1F(.NCT.FGJJ GC -TC 4 ’ ' 

■ FG3 RESET FALSE IN INOPT IF OPTION CARD NOT RECOGNIZED 

INPUT PARAMETERS NEEDED. 1C DEFINE E X TERN 4L D l S TO R E AN C ES 
GRAY I TY 

GRAY I TY GRADIENT 
CRB I T 

LCCALLY APPLIED FORCES 
* SPRINGS 

CAMPERS 
MCTUHS 

MOMENTUM WHEEL CONTROL 
, CONTROL SYSTEMS 

THERMAL OEFCPMA7 I ON - 

' . LTHER 

«.■ . . CALL IN TOR 

c . i, • - 

G-I 1 » t COMPOTE INTITIAL VALUES FOR ALL SYSTEM PAREMETEKS 

C TRANSFCRMA T ICN MATRICES 

C CENTER CF MASS YECTCRS 

C - . HINGE POINT VFCTCRS 

C INCRT I A TENSOR 

C FREE VECTORS 


CO 142000 
C0142100 
CO 142200 
CO 142300 
CO 142400 
CO 142500 
CO 142600 
CO 142 700 
C 0 14 2 000 
CO 142900 
CO 143000 
CO 143100 
CO 143200 
CO 143300 
CO 143400 
CO 14 3500 
CO 143600 
CO 143700 
CO 14380 0 
C014390C 
C0144000 
CO 14410C 
CO 144200 
CO 144300 
CO 144400 
CO 144500 
CO 144600 
CO 144700 
CO 144800 
CO 144900 
C0145000 
CO 14S10C 
CO 145200 
CO 145300 
C 9 145400 
CO 145500 
CO 145600 
CO 145700 
CO 145800 
CO 145900 
CO 146000 
CO 1461 00 
CC 146200 
CO 14630C 
CO 146400 
C 0 1 46500 
CO 146600 
CO 146700 
CO 146800 
CO 146900 
CO 14 7000 
C0147100 
CO 14720C 
00147300 
> T C014740C 
CO 147500 
CO 14 7600 
CO 147700 
CO 147800 
CO 147900 


A-10 


u u 


c 

c 

c 

c 

c 

d: 

c 

c 

c 


c. 



c 

c 

,c--. 

C - f . 


c • 


c 
c . 

Cl 

o' 

<■> 

c 


c 

c . 


LCCKED VECTORS 
RATE VECTORS 

COMPOSITE VECTORS ANC DYADS 
CROSS COUPLING 
EXTERNAL O.lSTUREANCfcS 
SYSTEM DYNAMICS 
MOMENTUM WHEEL DYNAMICS. 

ACCELERATION ABCUT-ALONkj FREE VECTORS 
DIRECTION COSINE PATES 

t = c 

CALL 0 YN ( Y . YD . NEO ) 

CUTPLT TOTAL SYSTEM STATE AT T=0 
CALL OUTPUT 
PRINT 1 Cl 
CALL OUTFSP 


START cASIC INEGR AT I ON OF SYSTEM EQUATIONS OF MOTION 
LSE F I MED STEP FOURTH. ORDER- RUNGE KUTTA 
2 CCNT INUE 

.. DECREES OF FREEDOM MAY BE UNCAGED ONLY AT THE START OF 
AN INTEGRATION STEP. CHECK IN UNCAGE IF IT IS TIME TO 
UNCAGE. SCG.EQ.O IMPLIES NC MORE UNCAGING TO BE DONE 
NCTE: INITIAL UNCAGING VELOCITY = 0, IMPULSE EFFECTS 

HAVE NOT EEEN CCCED IN PROGRAM 
IF (SCG.EC.OJ GO TC 3 
CALL LNCAGEl SCG.SC.T.TLG) 

, 3 CCNT INOt 

CALL RUNGE ( T . H ,Y . YC .NEC .NTG .TEM) 

.. ( SUBROUTINE RUNGE CALLS DYN IN AHICH ALL SYSTEM DIFFERENTIAL 
ECUATIONS ARE SETUP AND PUT IN THE YO ARRAY 

CHECK ENC OF RUN. FLAG 
IF ( . NCT .FGl ) GU TC 5 
(. CUTPLT COMPUTED PARAMETERS 
IF FOE TRUE PRINT 

- IF F05 false SKIP PRINT AND CO TO RUNGE -v 

, GEFALLT FUR FG5 IS TRUE EUT MAY BE OVERRIDDEN IN TORQUE ■ 
IF(.NGT.FGS) GU .TC 2 > 

CALL CUTFSP 

D’ HAS END CF RUN.FL'AG BEEN SET IN OUTPSP eY USER? 

IF <F0 I ) CU TO 2 
.. E, CCNT INUE 

. SHOULD A RESTART TAPE eE MACE? 

IF (LRTAREI go to e ■ 

CALL RET ART (2.Y.YC.NEC.7EM » 62 ) 

: E CALL OUTPSP 

■A CONTINUE ' 

USER SHCLLO WRITE OUTPUT CATA ON FILE 1 OF TAPE 11. REST APT 
IS PL T INTO FILE 2 CF TAPE 11 '• I I I » ? 

« ■ re w i no 1 1 ; " 


C . - ■• : 

C I • ' GC TO 1 TO SEE 

)?>T*'CO TC 1 

■ s STOP 
IOC FORMAT CAA) 

' 10 1 FORMAT ( • 1 • ) 

1 02 FORMAT ( AX . 1 7L1 ) 


IF ANOTHER N-B0D2 RUN FOLLOWS 

;ji it jo *?.< p r- iwa jja po* jaitit^i 


CO 1A8000 
C 0148100 
CO 14e200 
CO 148300 
CO 148400 

co i4esoo 
C014e600 
CO 148700 
CO 148800 
00 148900 
C 0 I 49000 
C0149100 
CC 149200 
CO 149300 
CO 149400 
CO 149500 
, .00149600 

CO 149700 
.. CO 1498C0 
CO 149900 
COISOOOO 
CO 150100 
CO 150200 
• i CO 150300 
CO 150400 
CO 15C500 
CO 150600 
CO 15070C 
CO 150800 
CO 150900 
CC 15100C 
CO 151 100 
C0151200 
CO 151 300 
CO 151 400 
CO 15 1 500 
CO 151600 
. • .‘■CO 151700 

CO 15 l 800 
CO 151900 
C 0 152 00 0 
C0152100 
CO 152200 
CO 1 52300 
CO 152400 
CO 15250 0 
CO 152600 
CO 152700 
CO 15280C 
CO 152900 
CATA CO 153000 
CO 153 100 
CO 153200 
' ' '■ ' CO 153300 

CO 15340C 
1 CO 153500 
CO 153600 
CO 153700 
CO 15380 C 
CO 1 53900 


A-l 1 


ENC CC 154000 


c 











C0200000 



SLERCUTINE DYN(Y 

, YC.NEQ) 






CO 200 IOC 

c 











C020020C 

G 


CEF IN £5 

. THE L CG l C AL PATHS 

THROUGH THE SUBROUTINES USED 

TC 

C0200300 

c 


St T 

UP 

THE SIMLLTANEJUS DIFFERENTIAL EQUATIONS 


CC200400 

c 


. CF 

MCT ICN 

FCR THE 

COUPLED Nh-tiCDY SYSTEM 



C020C500 

c. 











CO 200600 

jL-.c 









- : 


C O 20 0 700 

c 











C0200800 



IMPLICIT HEAL*8< A— H.O— Z.J) 


' , ** 




C02CC900 



LOGICAL FGi. 

FG2. FG3 • 

FG4 • FG5 

. 1NERF, R8LG. LEQU, LlNIT(l) 


CO 20 10 00 



LCGICAL 


NST ART 

. LRTAP 

L 





CO £01 100 

• G 











CO 20 1 200 

' c 











C0201 300 



INTEGER 





•» ' . * ' 




CO 20 1 400 


* 

A4GKK t 0T1 

. 

CT2‘ ‘ 

. CT3 


CT4 . . CT5 . 

FCCN 

• PCCN 


CO 201 500 


* 

SCNCLM# SCN 

. 

SCRDUM 

. SCR 

* 

SFKDUM. SFK , 

SFR 

• SG 

• 

CO 20 1600 


4 

SI . SIG ' 

. 

SI XDUM 

• S IX 

» 

SKDUM • • SK . 

SL 

• SLK 

. 

C0201 700 


* 

SMA » 5MCDLM, 

SMC 

t SMV 

. 

30K .. SPIDUM. 

SPI 

• SQF 

. 

C02018CO 


4 

SCL . SR 

• 

S SCN 

• SSIX 

• 

SVA . ...SVB . 

SVD 

• SV I 

* 

CC201900 


* 

SVM , S VP 

• 

SVO 

. SXV 


3XT r TUfiU • 

SMAL 

• SEU 

. 

CO 202 CC 0 


* 

SC • S CG _ 

• 

NFL XB 

. SFLX 

. 

SFXM .. NMCDS . 

SF CC 

. see 

. 

00202100 

« 

* 

I IN IT ( 1 ) 

• 

1 Z l N I T C 11 

• 

.SD 




CO 202200 

c . 











C0202300 

c 











C0202400 

c 











C0202500 

, /v 


RE AL 4 fcj 





■ - 




C0202600 

n r> 

* 

ANGC (33) 

. 

CNF 

C 3, 1C) 

. 

ETIC (3.10) . 

6 T MC 

(3.10) 

. 

C02C27C0 


'* 

FLO (3.20) 

• ; 

FLE 

(3.3.20 

i . 

FLH (3.3.20) • 




C0202800 


* 

TFACO (33) ' 

• 

Y MC 0 

(3,2.11), 

K l N I T ( 1 ) ' • - . 

RZINITC 1 ) 


.CO 2 0290 0 

C 








** 



C 0203000 

C . " 











C0203 100 



CGMMCN /CHEKS/ 



N £ T AR T # 

LRTAPC . *' 




C0203200 

c 











C 0 203 300 

c 








'* ! ‘ 

- 


C0203400 



CCNMCN /LOGIC/ 

FGI, F32 

. FG3, 

FG4, FG5, 1NERF, R8LO(lO> 



CO 20 3 50 0 

c 







'' 




C 0 20 3600 

c 

' 






„ . 




C 0 20 3 700 



COVMCN / IN TG / 


A40RK 

( 20C 1 

• 


" 



CC 203800 


♦ 

CT 1 

t 

CT2 


• 

CT3 . 

CT 4 


. 

CO 203900 


* 

C T5 

» 

FCON 

(03) 

• 

JCCN (10) • 

L CUN 

(22) 

* 

C 0.204000 


4 

MC (10) 

* 

Nei 


• 

NBCD • 

NCTC 


. 

00204100 


-* 

NFEP 

. 

NFKC 


• 

NFRC ' . 

NLOR 


. 

CC 204200 

or? a c 

‘4 

N M V 

• 

N MO • ' 


. 

NMOA .. ■ 1 ‘ 

NS VP 


. 

CO 204 300 


4 

N SVC 

• 

PCGN 

(11) 

. 

SD •' 

SFR 

(33) 

. 

C02C4400 


4 

SG 

. 

S l 

( E S')... . 

. 

SIG . • 

SL 


• 

CO 204500 

_ 'j ^ “ j 

.•4 

SLK. (33.) it 

.1-* 

u£MA.„ . 

('ICO an. 

ft 

) i V i » I. 

.5 QF 

( 11 1)1 -j > 


CO 204600 

* • 

4 

SCL (11) 

* 

£ MV 


• 

SR . 

SSCN 


• 

CO 204 700 


* 

SSI* 

. 

£ VA 


• 

SVB • 

SVD 


. 

C0204800 


* 

S V I 

• 

SVM 


. 

SVP (22) » 

SVU 

< 33 ) 

. 

C0204900 


4 

S > M (3.10) 

. 

£ XT 


* 

„T CRQ (*7) . 

SMAL 


. 

C0205000 


4 

SEU 

» 

N TQ 



SC (33) • 

see 


• 

C02051 00 


* 

NFLXB 

. 

SFLX 


• 

SFXM (10) • 

NMODS 


• 

C0205200 


4 

5FCC 

* 

£CC 

( 10 ) 






C0205300 


A-12 


COMMCN /INTGZ/ 


CO 205400 
CO 20 5500 
C02C5600 



* 

SC N CUM 

* 

SCN 

( 9 ) 

SCKUUM 

• 

SCR 

(9) 

* 

C0205700 


* 

S F K C L M 

• 

SFK 

(9) 

S IXDUM 

• 

SIX 

( 9) 

• 

C 0 2 05800 


* 

SKDU4 

• 

SK 

(9) 

SPIUUM 

• 

SPI 

(9) 

• 

C02C5900 


* 

s nc Cum 

• 

SMC 

( 9 ), 







C020600C 

c 












C02C61 00 

c 












CO 206200 


CQ ^ M C N 

/REAL/ 









CO 206300 


* 

c a 

(5.10) . 

CAC 

15.10 . 

CL M 

t id) 


CCMC 

(3.11) 


C 0 20 64 0 0 


* 

DCMC 

(5.11) . 

ETC 

(5,11) , 

t TM 

(33) 


FUMC 

(3.11) 


C 0 206500 


. * 

G AM 

(5.60)' ■ 

h 


HM 

(3,10) 


HM C 

(3.10) 


CO 206600 


* 

H VC ^ 

( 1C) . 

FmI 

(5.11) . 

PLM 

(10) 


OF 

(3.35 ) 


■ CO 2067 CC 


♦ 

QFC 

(3.33) . 

CL 

(5.22) 

QlC 

(.3.22) 


RCMC 

(5.11) 


C 0 206800 


* 

T 

• 



THA 

(33) 


THAD 

( 33 ) 


C02069C0 


• * 

TI-ACW 

( 10 ) . 

ThA W 

(10) , 

XDIC 

( 3 .3 ,66 ) 


XI 

(3.5,10) 


C02C7000 

’ . 

*■ * 

X I c • ' 

( 3i'3. 10 ) . 

XVAS 

(10) - . 

XMN 

(33,33) 


XMT 

(3,3.10) 


CO 20 7 IOC 

; 

♦ 

TOG 

( 53 ) . 

FLA 

(5,20) . 

flb 

( 3,20 ) 


FLC 

(3.20) 


CO 207200 


* 

fld 

(5. 3. 20 ) . 

FLJ 

(5.3 .20 j . 

C AQ 

(3,10) 


X 1 (j 

(3.3,10 


CO 207300 

C ’ 












C0207400 


. * 

FLIRC 

(5.10) . 

FLCRC 

(5.10 , 

flag 

(3.20 ) 


FLQC 

(3.20) 


C0207500 


* 

FLCM 

(20 

ZETA 

( 20 ) , 

fcf 

(3.3,40) 


FCK 

( 3,40 ) 


CO 20 7600 

- 

/ * 

T IMENO 










CO 2077 00 

c 





. - • ■ 







C 0 207800 



CCMMC N 

/REAL Z/ 









CO 20 7900 


• * 

CGDLM 

(1.3) 

CL 1 

(3.10 . 

CcJCDUM < 1 » S ) 

9 

CBC 

(3.10) 

• 

C0208C00 


* 

XMCCLM (1.1. 9). . 

XMC 

(5.3.10). 

CBN ( 3 ) 





C02081 00 

C„. 












CO 2082 00 

c 










l 


CO 208300 

" . . 


EQLIVALENCE ( ETM( 1 ) . TH AOCI 1 ) ) 


. ( X MN ( 1,1) 

, ANCDll 

) ) 


C020e400 


' ♦ 


( XMN (1.3). 

Y M CD ( 1,1,1)) 

, (XMN1 1,6) 

,CNF( 1. 

1 ) > . 


C0208500 




<XMN( 1 .B) , 

ET IC ( 1 . 1 ) ) 


. (XMN( 1 , 1 0 ) ,ETMC< 1 , ) ) ) , 


CO 20 8600 


’ * 


( F LB ( 

i.i). 

FLG( 1.1)) 


. (FLE (1.1 

• 

1 ).FLD( 

1.1.1)). 


C02C8700 


* 


(FLHT 1,1.1 

) , F L J ( i , 1 , 

i > > 

• 





CO 20 8800 


* 


(FGl 

L INIT( 1 I ) 


, ( C A ( 1.1) 

• 

W IN IT ( 1 ) ) * 


CO 208900 




(CBDUM(1 ,1 

I.RZINIT(IJ) 

, ( AWCRK1 1 ) 

, 1 1 Nil T ( 1) ) 


C C 209000 


C 

C ■. 

. iC 

C " 
1 O ! , 

c 

c 

c 


1 SCNOLM . I Z IN IT ( 1 ) ) 


DIMENSION Y ( NEO) . VC ( NEC) 
LOGICAL LG(33) 


COLNT TIMES THRU CYN 
CT4 = CT4 + 1 

CHECK FLK FIRST PASS 
IF (CT4 .GT. 1 ) GO TO 1 

MAKE USE OF .ss. ; 

KMT = NOMINAL STATE TRANSFORMATION MATRICES • 'I* 

CF ; =: -FREE^ COCRD IN ATE VECTORS ’ 

THA = INITIAL ROTATICN A 60 UT QF VECTOR 
T,C COM, RUT, E mauilNIT IAU iVlA,LLES4.F t UR, THE ICC MF ONE NTS £JF THE..; * , 
TRANSFORMATION MATRICES. . 

KMC = TRANSFORMATION MATRIX AH 1 CH TAKES VECTORS FROM 

BODY FIKEO COORDINATES To COMPUTING FRAME COORDINATES 
CALL TRNS I VI XM T , QF ,THA . JCCN ,PCON • N80D « R BLU . INERF , XMCDUM . XMC ) 

GO TC 2 


C0209100 
C02092 00 
CO 209300 
CO 2094 0 0 
C 0 209500 
C0209600 
CO 209700 
C02C9800 
, CO 209900 
C021 0000 
C0210100 
CO 21 0200 
C021 0300 
•C021 0400 
C021 0500 
C021 0600 
-C021 0700 
C021 0B00 
C021 C900 
C021 1000 
C02I 1100 
C02I 1200 
, CO 2 1 1300 


A-13 


n n o n n n n r, n n .on. 0,0000000. n , . o 0000. 0000 o 00 


CONTINUE 

RETURN FERE AFTER INITIALIZATION PASS THROUGH DYN 
. SORT GET QUANTITIES IN ARRAY Y 
caLl St TLP ( Y . YC .NEC . .TRUE . ) 

COMPLETE TRANSFGRMAT IC.N MATRICES ARE NOT OBTAINED VIA INTEGRATION 
. SIX CF NINE ELEMENTS IN EACH MATRIX HAVING LABEL IN SO DETAINEE 
BY INTEGRA T I C N . REMAINING ONES 3Y ORTHOGONALITY 
. MATRICES WITH LABELS NCT IN SO. ASSUMED OBTAINABLE AL GE ER A C I ALL Y 

gy small Ancle or euler angle techniques 

CALL TRAN 

1F(CT4.NE.I) GC TC 3 
.FIRST PASS THROUGH 

TAKE INTO ACCOUNT SET SVD . CRLt’ TrtCSE VECTORS AND DYACS WITH 
BCDV LAEELS IN SET SVC ARE TO 3E TRANSFORMED 

compute of anc ql ' ve ctcrs. not def ined by input using 

•VECTOR CKCSS PROCUCT DEFINITION '' 

.; GET ALL VECTORS AND. CYACS INTO COMPUTING REFESEKlCfc FRAME 
SET CP SETS WHICH SPECIFY EXACTLY WHICH VECTCRS TO EE 
TRANSFORMED FCR CC LOCPS IN TfiANVO 
CALL VO I v 

SET LP INITIAL VALLES FCR ECUATICNS AS T hE Y GO INTO RUNGE 
C,A LL EC I V( Y . NEC) 

GO' TC <t 


NOT FIRST PASS THROUGH 

TRANSFORM ONLY SELECTEC VECTORS AND DYADS 
MAKE CSE OF XMC TC TRANSFORM ALL BODY FIXED' VECTCRS’ AND CYAC INTO 
COMPUTING FRAME CCOROINATES 

CAC = XMC*CA - CENTER OF MASS IN SET SVA 

CEC = XMC*CE ■ - HINGE POINT IN SET SVB 

' , QFC = XMCAOF - FREE VECTOR IN SET SVG 

ULC = XMC«GL - LOCKED VECTORS IN SET SVP 

XIC = XMC*X I »< XMC) **< -1 ) - INERTIA dyad’ IN SET SVI 

HMC = XMC*HM - WHEEL AXIS IN SET SVM 

CALL tranvd 
ccnt INUE 


XMC*CA 

xmc*ce 

XMC*OF 

XMC«OL 

XMC * X I * ( XMC ) **< - 1 ) 
XMC *HM 


MAKE LSE OF free VECTORS IN COMPUTING FRAME COORDINATES AND 
RATE AECUT OR ALCNG THEM TC DEFINE ALL RATE DEPENDENT TERMS 
CALL RATE ' t V : • - 


MAKE CSE OF TRANSFORMS C EODY FIXED VECTORS AND DYADS TO CONSTRUCT 
TFE MATRIX OF INERTIA AND F SUED J I NER T I A TENSORS 

PASS ONE - COMPUTE ELEMENTS. " 

skip all zero elements - ■ 

TRUNCATE SUMMATIONS USE SET SPI 
TFERE'AFTEK - COMPUTE ELEMENTS. 

SKIP ALL ZERO ELEMENTS 

SKIP TIME CONSTANT ELEMENTS USE 5ET SXT 
TRUNCATE SUMMATIONS USE SET SPI ’’ 


TFERE'AFTEK - 


C f! ■} 

CALL XOY 


MAKE LSE OF VELOCITY ANC ECCY FIXED VECTORS TC COMPUTE GYROSCOPIC 
CROSS COUPLING TERMS 

INERTIA CROSS COUPLING TRUNCATE ACCORDING TO SIX(I) 
CCNTRIPITAL CROSS CCLPLING TRUNCATE ACCORDING TU SCN(I) 
CORIOLIS CROSS COLPLINC- TRUNCATE ACCORDING TC SCR ( I ) 


n n no 


c 

c 


MCKENTuM »HEEL COUPLING NGT TRUNC A TED 
FLEXIBLE BODY EFFECTS NCT TRUNCATED SET SFLX 
CALL ETA 
C 

C MAKE USE OF PUSITICN ANC RATE INFORMATION TO COMPUTE 

C ALL NON-GYR C5C0P IC TGRCLES 

C NOTE - SUBROUTINE TORQUE IS LSEK DEFINED (EMPTY IF NOT) 

CALL TURCUEI Y . YO . NEQ ) 

C 

C MAKE USE UF FREE COORDINATE VECTOR TO DOT VECTOR-CY ADI C EQUATION 

C OF MuTICN TO GET ACCELERA T ICNS ABGUT FREE COORDINATE AXES 

C ALSC SET UP AND EXPAND EOLATIONS TC ACCOUNT FOR VARIABLE SFEEO 

C MOMENTUM WHEELS AND FLEXIBLE BODY EFFECTS 

CALL OF COT 

C EXIT FRCM JFOOT w I TH ECLAT ICNS UF MOTION IN SCALAR FORM 

C 

C KECUCE THE CFDOT EOLATIONS TO OBTAIN TNADD 

C ENTER sIMU WITH ELEMENTS XMN AND ETM OBTAINED IN QFDOT . 

C. EXIT W I TH ACCELERATIONS TpAUD. XMN DESTROYED IN SIMQ 

C EQUIVALENCE POTS TH ADC AND ETM IN SAME STORAGE LOCATION 

C 

C CHECK TC SEE IF ANT OEGREES CF FREEDOM CAGED 

IF(SCG.NE.O) GO TC 5 
C NCNc CAGED 

N = NFEh+NMVFNMUOS 

(ALL SINC( XMN, THACC.N ,33 ) 

GO TC fc 
5 CC NT INUE 

C CNE DR MORE CAGED CEGREES UF FREEDOM 

c celete ano renlmoer rows ano cols of xmn.etm in comprs 

C SOLVE reduceo set of eolations in simq ^ 

C RESTRUCTURE T H ADC ARRAY PLUGGING IN EERCS IN UMPRS 

N = NFER4NMV+NM0DS-SCG 
CALL CCMPRS( XMN .TFADD ,N, SC . SCO .LG> 

CALL S IMQ( XMN. THACC ,N ,22 ) 

(ALL UNPRS(TFACD.N.SCG.LG) 
t CONTINUE 

DEFINE DIRECTION CCSINE ECUATIONS IN ACCORDANCE WITH SET SO 
CALL DC T 

CEFINE ANGULAR PUSITICN EQUATIONS ACCORDING TD SFR(I> AND SMA ( I ) 
CALL ANGLE 
C 

C FUT ALL FIRST ORDER EQUATIONS IN ONE DIMENSIONAL ARRAY ACCEPTABLE 

C TC INTEGRATION ROUTINE RUNGE 

CALL SETUP (Y . YD .NEC , .FALSE . ) 

IF(T .GE.T1MEND) GO TO 50C 
RETURN 
C 

SCC CONT INUE , 1 . , ; ; , 

FG 1 = . F AL SE . 

RETURN 

£NC 


C 02 1 7400 
C02I 7500 
CO 21 7600 
C021 7700 
C021 7600 
C 0 21 7900 
C 0 2 1 8000 
CO 21 81 00 
CO 21 8200 
CO 21 8300 
C0218400 
C021 8500 
C021 8600 
C02! 8700 
C02I8800 
CO 21 8900 
CC2I 9000 
C02I9100 
C 6 21 9200 
CO 21 9300 
00219400 
C021 9500 
C021 9600 
CO 21 9700 
C 021 9800 
CO 21 9900 
C C 22 00 00 
C 022 0 100 
C0220200 
C0220300 
C022040C 
CO 220500 
C0220600 
C 0 22 07 CC 
C0220800 
CO 220900 
C0221 000 
C0221 100 
C 0 22 1200 
C0221300 
C 0 22 1 400 
C 0 22 1 50 0 
C0221 600 
C022 1700 
C02218C0 
C 022 1900 
C0222000 
C 0 222 100 
CO 222200 
CO 222 300 
C0222400 
C0222500 
C0222600 
CO 222 700 


' 1 ' 1 ' ’ ‘ ■ 1 ' • ! r i ; ; ; • ‘ ' i r i -v n-wy ’ r i v M I Mt t i ] T i / = ■ 


C 


C 0 300 00 0 
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r> n r> n n o no n nr\or»nnnr* 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


SLERCUTINE R ST ART ( J . Y . YC , NE C . TEM . * ) 


ZEKC OUT ALE ARRAYS OR FILL THEM IN FRCM THE RESTART TAPE 
ATT HE END CF RUN CREATE A RESTART TAPE. TO DC THIS 
PUT TEE RESTART CATA IN FILE 2 UF TAPE 11 

NOTE: APPROPRIATE JOB CCNTRCL LANGUAGE FUST ACCOMPANY 

SUGGESTION! FILE 1 ON TAPE 1C PREVIOUS OUTPUT DATA 
- FILE 2 CN TAPE 10 RESTART CATA 

KITH A UTILITY ROUTINE COPY FILE 1 OF TAPE 10 
ONTO FILE 1 OF TAPE 11. THEN PUT NE ■ OUTPUT DATA 
RIGHT AFTER IT KiTHOUT AN EOF MARK, TAPE 11 KILL T 
HAVE IN FILE 1 A CONTINUOUS RECCRO OF THE OUTPUT 
DATA FROM T =0 

AT END OF RUN NEK RESTART DATA FUT AFTER AN EOF MAR 
ON TAPE 111 IT KILL TFEN BE IN FILE 2 OF TAPE 11 
. CLO TAPE 10 KILL Bg UNDISTURBED 

IMPLICIT KEAL*8( A-H.O-Z . i > 


C 0 300 100 
CO 200200 
C0200300 
CO 200400 
CC200500 
C 0 30060 0 
CO 300700 
C030C800 
C 03 00900 
C 0201 000 
C0201 100 
CO 30 l 200 
C0301 300 
F EN 00201400 
C 030 1 500 
CO 30 1 600 
K CO 30 1 700 
CC301 800 
C03C1 900 
C 0 302.00 0 
C 0 202 100 
CO 202200 


LOG I CAL 


FGl . 

FG2 

. FG3. . 

FG4 • FG5 

. INERF 

• 

RBLO. 

LEOU . 

LIN 

I T ( 1 ) 


C 0 302 300 

LOGICAL 




NSTART . 

LRT APE 









C0302400 















CO 302 500 

INTEGER 














C03C2600 

* AKCRK 


CT1 

* 

CT2 . 

CT2 

CT4 


CT5 


FCON 

• 

PCCN 

• 

C0302700 

* SCNCUM 


SCN 

• 

SCRDUM . 

SCR . 

SFKCUM 


SFK 


SFR 

• 

SG 

» 

CO 302800 

* S 1 


SIG 

• 

sikouM, 

six 

SKOUM 


SK 


SL 

• 

SL K 

• 

C0302900 

* SMA 


SMCDUM • 

SMC . 

SMV . 

SCK 


SP IDUM 


SP1 

• 

SUF 

« 

C0303000 

♦ SCL 


SR 

* 

SSCN , 

s s i x , 

S V A 


SVE 


SVD 

• 

sv i 

» 

CO 3031 OC 

« SVM 


SVP 

• 

svo . 

SXM , 

SXT 


TORO 


SMAL 

• 

SEU 

• 

C0203200 

* SC 


SCG 

• 

NFLX8 . 

SFLX , 

SFXM 


NMUDS 


SFCC 

• 

see 

• 

CO 203300 

* I IN 1T( 1 

) 

• 

1ZINITI 11 

SO 








C0303400 















C0303500 















C 0 30360 0 

REAL*e 














CO 20 3 70C 

* ANGC 

<33> 

• 

CNF I 

2,10 . 

ETIC 

(3 

.10) 

• 

ETMC 

(3.10) 

* 

C030J800 

* FLQ 

t 

2.20 1 

t 

FLE ( 

2.2 ,20) , 

FLH 

(3.3.20) 

t 





CO 303900 

* TFACO 

( 

231 

• 

YMCD < 

2,2.11), 

RINIT 

( 1 ) 

• 

RZINIT I 1 ) 


C C304C0 0 















C0304 100 















CO 2 0420 0 

, ccmmcn 

/CHEKS/ 



NSTART, 

LRTAPE 








C0304300 


COMMON /LOGIC/ FG1. FG2. FG3, FG4. FG5. 1 NE RF , RBLU(IO) 


CO 2 0 A 400 
C0304500 
CO 204 600 
CO 204700 
C0304800 


COMMON 

/ IN TG / 

AKORK (200) 

• 






CO 204900 

* 

CT 1 


. CT2 

• 

CT 3 


t 

CT4 


. CO 205000 

+ 

C T 5, , 


.. FCON | ( 2 3 ) 

• 

JCCN 

(10) 

. • 

LCON 

(22 > 

, C0205100 

* 

MC 

( Id 

. NB1 

* 

NdQD 


'* 

NCTC 


. C 0 3052 00 

* 

nfer 


. nfkc 

• 

NFRC 


• 

NLOR 


, C0305300 

* 

NMV 


. NMO 

• 

NMOA 


» 

NS VP 


. C0305400 

* 

NSVC 

■ . . * i 

- IVpCGN v ( 1 1 ) 

t 

so ! ; 

i tl :t i 

•-V; 

SFR 

, (33) 

, 0030S50C 

* 

SG 


.SI ( S5 ) 

• 

SIG 


• 

SL 


, C030S600 

* 

SLK 

(23) 

. SMA ( 10) 

* 

SDK 

( l ) ) 

* 

SOF 

(11) 

, C0205700 

♦ 

SCL 

( 11 ) 

. SMV 

• 

SR 


« 

SSCN 


, C030S800 

« 

SS I * 


, SVA 

* 

S V 0 


» 

SVO 


. C03C5900 

* 

SVI 


, SVM 

• 

SVP 

(22) 

• 

SVC 

(33) 

, C 0306000 
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U L ■ uu uu uuuuu 


♦ 

S XM 

(3.10) . 

SXT 


• 

TLJKG 

(97) 

SMAL 


* 

CO 2 06 10 0 

* 

seu 

• 

NTQ 


» 

SC 

(33) 

see 


* 

CO 306200 

4 

NFLXvJ 

• 

$FLX 


, 

SFXM 

( 1C > . 

NMUDS 


* 

C03063C0 

4 

SFCC 

• 

see 

(1C 1 







CO 306400 
CO 306500 
00306600 

CCKMCN 

/ INTCiZ/ 









C 0 3 06700 

4 

SCNCUM 

• 

SCN 

( 9 ) 

f 

SCRDUM • 

SCR 

(9) 

* 

C0306800 

4 

sfkclm 

• 

SFK 

(9) 

f 

STXDUM • 

SIX 

(9) 

• 

C03C69C0 

4 

skdlm 

• 

SK 

( 9 ) 

» 

SPIDUM • 

SPI 

(9) 

• 

C0307000 

4 

smccum 

• 

smc 

(9) 







CO 307 1 00 
C0307200 
CO 307300 


COMMC N 

/KCAL/ 









C03C7400 

4 

CA 

C ^ * 1 0 > . 

CAC 

(3.10 


CLM 

(10) . 

CO MC 

(3.11) 


C03C7500 

4 

DC MC 

(^#11 ) . 

ETC 

(3.11) 


fc'TM 

(33) 

FCMC 

(3.11 ) 


C0307600 

4 

GAM 

( 3 • 66 ) • 

h 



HM 

( 3 • ) 0 ) 

HMC 

(3.10) 


C0307700 

4 

hmom 

( 10 ) 

PHI 

(3.11) 


PL M 

( >0) . 

OF 

(3,33 ) 


C0307600 

4 

QFC 

( 2 * 33 ) * 

CL 

(3,22) 


QLC 

(3.22) . 

fiCMC 

(3.11) 


C C30790C 

4 

T 

% 




THA 

( 33 > . 

THAO 

(33) 


C0308000 

4 

ThACVl 

< 10 ) . 

ThAw 

(101 


XOlC 

(3,3, 66 ) , 

X 1 

(3,3,10 


C0308 100 

« 

x ic 

(3.3.10). 

XMAS 

( 10) 


XMN 

(33.33) . 

XMT 

(3.3,10 


C0308200 

4 

TUG 

(33) 

FLA 

( 3 ,20 ) 


FLB 

(3.20) . 

FLC 

(3.20) 


CO 308300 

4 

FLO 

(3. 3.20 ) . 

FL J 

( 3.3 .20 ) 


CAO 

(3.10) . 

x io 

(3.3. 1C) 


C030e400 

4 

FLIRC 

(3.10) • 

FLCRC 

(3.1C) 


FLAC 

(3.20) . 

FLQC 

( 3.20 ) 


CO 308500 

4 

FLOM 

(20) 

2ETA 

(20) 


FCF 

I 3.3 ,40 ) . 

FCK 

( 3,40 ) 


C0308600 

4 

T imend 










CO 308 700 
C 0308800 
CO 3 0890 0 


ccmmcn 

/REALZ/ 









C0309000 

4 

cedlm 

(1.3) . 

CB 

<3,10 

• 

C UCDUM ( 1,3) , 

CtiC 

(3.10) 

• - 

CO 309 10 0 

4 

X MC C LM (1*1.9) . 

XMC 

( 3 .3 . 10 ) 

• 

CUN ( 3 ) 




C0309200 












C 0 3093 00 


CCMMCN 

/SATLlL/ DLMMY(IOCC) 







C03C9400 












CO 309500 


eqlivalence (etm< i > . thacc < i ) ) 



. ( XMN ( 1.1). 

ANGD(l)) . 


C0309600 

4 


<XMN( 1,31 . 

YMCO (1,1, 

1 ) ) 

, ( XMN ( 1.6). 

CNF ( 1. 

1) ) 


CO 309700 

4 


( XMN ( 

1.8). 

ET IC( 1 ,1 ) ) 


, ( XMN ( 1 .10) 

.ETMC( 1,11) , 


CO 309800 

4 


(FL8( 

1.1). 

FLQ< 1,1)) 



, (FLE (1.1.1 

) » FLO ( 

1.1.1)). 


C C 30990 0 

4 


( FLH ( 

1.1,1 

) .FL J ( 1 , 1 

• 

1 ) ) 

• 




C 0 31 0000 


* (FG1 ,L1NU( 1 ) 1 

* <C8DUM< 1 . 1 ) .RZIMTt 1 > ) 

* (SCNOlt’.lZIMlIl)) 


,ICAI 1,1) .R 1N1T ( 1 ) ) 

. (A«GNK( 1 ) . I INIT( 1 ) ) 


C I ME N S I CN Yl 16 0) , YC( 160 . TEM(2.160> 

COMMCN ELOCK SIZES 

IDEM 4 = 16 

IDEM S = 724 

IDEM f = 70 

IDEM7 = 4364 

IDEM E = 166 

IDEM 9 = 1000 

GO TC ( 1 .2 ) . J 

INITIALIZE all storage locations to zero 

I CO 3 I=1,IDEM7 
3 F1MK l ) = 0 .DO 


C0310100 
C031 0200 
CC31 0300 
C031 0400 
CO 31 0500 
CO 3 1 060 0 
C0310700 
C031 0800 
C031 0900 
C 0 31 1000 
C031 1 100 
0031 1200 
CO 31 1300 
CO 31 1400 
C021 1 50C 
CO 3 1 1600 
CO 31 1 ZOO 
CO 3 1 1800 
C 0 31 1900 
CC 31 2000 
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4 

1 c 

1 1 

l*£ 
1 3 


1 4 


C 

£ K' V -J 

C 

1 0 1 
10 £ 
r "'l oS 


CO 4 I=l.lDEMS 

CUMMY< l > = O.DC 

CO 1C I=l.IDEM8 

RZINITI I ) = 0 • DO 

CO 11 1=1. ID CMS _ 

IINIT(I) — 0 
CO 1 £ I=1,IDEM6 
IZ IN 1T< t > = 0 
CO 13 1=1. IDEK4 
.LIMKI) = . TREE . 

CO 14 1=1.160 

yin = o.oo 

YC ( I 1 = C.DO 

TEK1 1 . 1 J = 0 .00 

TEX < £ ,1 ) = 0 .DO 

IF( .NGT.NSTART) RETURN 

RESTART RUN LOAD ALL CCVMCN BLOCKS AND LOCAL ARRAYS FROM 
THE RESTART TAPE. TAPE 1C FILE 2 
PE AD (10. 102) Y 
RE AO ( 10 • 132) YO 
RE AD ( 10 . 101 ) NED 

READ (10.102) (OUXMYI I ) . 1=1 , IDEM9) 

RE AD ( 10. 102) (RI M.T( I ) . 1=1 . IDEM7) , 

READ < 10.102) <RZ INI T( I ) .1 = 1 .IDE MB). 

RE Ap ( 1 J , 1C1 ) ( I INI T( 1 ) , 1= 1 , JCEM5) 

READ (1 0 . 101 ) < IZINITC I ) , I = 1 . I0EM6) 

RE AO < 10. 10 1 ML INI T( 1 ) , 1= 1 , ICEM4) 

NSTA'RT = .FALSE. ' ' 

FG1 = .TRUE. 

UPDATE TERMINATION TIME 
READ 103. T 1 MEND 

ALL CATA REOUl RED TO RESUME COMPUTATION HAS BEEN. INPUTTED 
GC TC THE START OF TP £ INTEGRATICN LOUP IN MAIN 
PE TURN 1 ’ ' . ! 


PUT EOF MARK CN 
IN FILE 2 OF 
ENC FILE 11 
•RITE! 1 1 .102 ) 

»R ITE < l 1 .1 02 ) 

• RITE <11 .101 > 

»R ITE I l - l • 102 ) 

• R I T E { 1 1 .102 ) 

»R ITE ( 1 1 .1 02 ) 
•RITE ( l l . 1 0 l ) 
»R ITE (11.101) 
•RITE (11.101) 
REST IN PEACE 

• FURTHERMORE 

FORMAT (16ZB) 
FORMAT (EZ16) 
FORM A T ( D 15.5 ) 

RE TURN 
ENC 


TAPE 

TAFE 


TO SEPERATE 
PUT RESTART 


restart 

DATA 


DATA Ffi CM OUTPUT, CATA 


Y 

YD 

NEG 

(DUMMY! I ) . 1=1,1 0EM9) 

( R I NI T< I ) .1 = 1 .IOEM7) 

I R ZINI T< I ) . 1 = 1 . I0EM8) 

( I INI T( I ) . 1 = 1 . IDEM5 ) 

( I ZIN IT< I ) , I = i . IOCM6) 

< LINI T ( I ) . 1 = 1 . IDEM4 ) 

ALL CATA NEEDED TO RESTART JOB IS 
CLD RESTART TAPE. TAPE 10 HAS NOT 


CN F ILE 2. TAPE 
BEEN DESTROYEC . 


CO 31 2 100 
C031 2200 
C0312300 
C031 2400 
C031 2500 
C 0 21 2600 
0031 2700 
C0312B00 
CO 31 2900 
C031 3000 
C0313100 
C031 3200 
C031 3300 
C 031 3400 
CO 31 3500 
CO 31 3600 
C 0 31 3700 
-CO 31 3800 
C031 3900 
C 031 4000 
0031 4100 
C021 4200 
0031 4300 
C031 4400 
CO 31 4500 
C031 4600 
CO 31 4 70,0 
CO 31 4800 
00314900 
C C 31 5000 
C 0 31 5100 
CO 31 520C 
CC 31 5300 
CO 31 5400 
C031 5500 
C03I 5600 
0031 5700 
C0315800 
C03I 5900 
C 0 31 6000 
C0316I00 
CO 31 6200 
CO 31 6300 
CO 31 6400 
CO 31 6500 
CO 31 660 6 
C0316700 
C031 6800 
CO 3 1 690 0 
1 00 31 7000 
, C0317100 
C031 7200 
C031 7300 
CO 31 7400 
C03I 7500 
CO 31 7600 
CO 31 7700 
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c 

c 

c 

c 

c 

c 

c 

c 

c 


SueKCLTINE I NB 5 


ACCEPTS ALL INFORM AT IC N NEEDED Tu DEFINE EASIC N-BODV SYSTEM 
1 ) TCPOlUG Y 

I) INERTIA CHARACTERISTICS 
S ) CEOMETRIC CHARACTERISTICS 

4 ) KINEMATIC TRANSFGFMAT I JN 

5) MCMENTUM WFEELS. CYRCSTATS 
fl INITIAL CUNCITICNS 

7) FREE AND LCCKED CCOftCI'NATE AXES 
E) INTEGRATION STEF SIZE 

*********** INeS INPLT CATA SETUP *********** 


CC430000 
CCAOOl 00 
C0400200 
C04003C0 
C0400400 
CO 40 0500 
C0400600 
C0400700 
C0400800 
" C04C0900 

C0401000 
C0401100 
CC401200 
C0401300 
C0401400 
FCfiM ATS C0401 500 
♦ CCDES C 0 4 0 lb 0.0 
*** + *** CC40 1700 


C 

C 

C 

C 

C 

c 

c 


CC401 800 



t\QCC 




A 

ICO C0431900 







C 0402000 

*** <+**4 4***+ 

NBOD SETS OF 

THE FOLLOWING CARDS. 

ONE PEP BODY 

* *4 **' *** CO A 02 1 0 0 

+ 

N 

MESS! J ) 



e 

1 C5*C0402200 

r* 

RBLCI N ) 

JCONI N ) 

PCOMNI 

XMAS (N ) 

'C 

I C 1*C0402300 

♦ 

XIII . 1 . N ) 

X I ( 1 . 2. N ) 

XIII. 3. N1 


c 

I C2* C0402400 

* 

• • X It 2 . 1 . N ) 

XI {2. 2.M 

XI12.3.NI 


D 

l 02*00402500 

■* 

XI (3 • 1 ,N J 

XI (3.2.N) 

XI I3.3.NI 

*■ 

0 

1 02* CO 402600 

* 

XMT ( 1 • 1 .N > 

XM T ( 1 > 2 . M ) 

X.4TI1.3.N) 


E 

I 02*C04C2700 

* 

XMT I 2 . 1 .M 

XMTI2.2.M 

XMTI2 . 3 .Ml 


E 

1 C2*C 0402800 

* ' 

XM T l 3 . 1 . N ) 

XMT ( 2 • 2. N ) 

XMT13.3.NI 


E 

1 02*00402000 

* 

CA < 1 . N ) 

(A12.M 

CAI3.N) 


F 

102*00403000 

* . 

CB ( 1 ,N ) 

ce(2.M 

cai j.ni 


G 

1 02*00403100 

+ 

CF ( I . M ) 

OF! 2. Ml 

OF I 3. Ml 


K 

1 C 2* CO 4 0320 0 

+ 

OF I 1 .M + 2 ) 

OF ( 2. M*2 1 

UF13.M+21 


P 

1 32*00403300 

* 

TPAIM) 

TEAT M * 1 I 

THAI M+2 I 


H 

102*00403400 

* 

THACI Ml 

THADIM* 1 1 

THADIM+2 l 


P 

I 02* CO 403500 

* 

CF ( 1 . M 1 

OF I 2 .. M 1 

OF 1 3 . M I 


I 

102*00403600 

♦ 

CF (1 .M> l ) 

OF (2. M* 1 ) 

OF I J.M+l 1 


I 

102*00403700 

•* 

TFA(M) 

THAIM+1 ) 



* I 

1 02*00403600 

ik 

THAC(M) 

THACI M* 1 I 



I 

1 02*00403900 

* 

CF < l . I 

CF I 2 . M ) 

QFI3.MI 


J 

102*00404000 

* 

CL ( l .L ) 

CL( 2 . L 1 

OLI 3 .LI 


J 

1 02*00404100 

* 

T F A ( M I 




J 

102*00404200 

* 

THAD ( M ) 




J 

102*00434300 

* 

! CL I l .L I 

CL I 2 . L I 

OLI 3 .L i 


' k' 

1 02* CO 4 04 40 0 

* 

CL 1 1 .L ♦ 1 1 

OL 12. L* 1 I 

OLIJ.UI I 


K 

1 C2* C C404500 

*4*4*444+*++* 

E NO OF SE T CF 

60CY N DESCRIPTIVE 

CARDS ****************00404800 







C0404700 

PCCM N3C0 + 1 ) 




L 

ICO C0404800 

» v 

THADIM) 

'tfaci'mi 

THACI ME II 

V, '4 4M 1.(4) 

' TH ADI M* 1 I 

THADIM+2) , 

ir. i . - - ‘ 

H *\ v , ri ^ -{ ' 1 ** >■>'■ 

N 

l 02.. CO 404900 
102 C 0 4050 00 


THAO ( M ) 




0 

102 C0405100 


N M C 




• * 

1 CC C0405200 

1 ’ 

' ' 



i ti 


r . C 0 4-3 53 C 0 

+ 

************ 

NMO SETS OF TPE FCLLUXING CAROS. 

ONE PER A PELL 

+ + + + 4 ***C0A054CC 

+ 

MOI l 1 

H M I 1 . I I 

HM< 2. I ) 

HM ( J. I ) 

0 

1 04*00435500 

* 

PC M ( l I 

MESS! J 1 



R 

1 06*00405600 

* 

THA* ( I I 

TFADM I l 



S 

1 02* CO 40 5 70 0 

* 

************ 

END OF SET CF 

APEEL i DESCRIPTIVE 

CARDS ************ ***C0«058C0 


C 0 4 05900 
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Anorinnnpnnonnonnnnnr-nonr. nnnr\oriOonnnonnnr>nrto 


TIMEND T 102 C 0 406000 

C 0 406 1 00 

*4*4****t*« END CF CATA CALLEC FOR ay INBS . **»****w***»W*W*********CQ406200 

CO 4063 00 

C COE LIST ■ CO 4064 00 

CO 406500 

A - ALWAYS READ, FIRST CARD READ 8Y.IN3S C0406600 

NBUD=TGTAL NUMBER OF BODIES ( R I GI DFFLE X I oLE HP OI NT .MASSES) C0406700 

C 0406800 

e - first card for each set cf buoy description carcs C0406900 

N=BUDY number (SETS TO bE READ SE GU E NT I ALLY N=l,2,... CC407000 

mess(j)=any alphanumeric message will be printed as a fe adingco407ioo 


FCR ECO Y N,.IN THE INPUT DATA ECHO , PR I NTED By INBS 

C - EECLNO CARC FCR EACH SET OF BODY DESCRIPTION CARDS 

JCCMn)=HOOY LABEL CF ECDY CONTIGUOUS TO AND INBOARD OF 
BODY N, HINCE RCINT BETWEEN BODIES JCON(N) AND N 


C0407200 
CO 407300 
C0407400 
C0407500 
CC407600 


IS OEFINEC AS HINGE PUINT N-I, IF N= I THEN J CC N ( l ) = 0 C 0 40 7 700 


AND HINGE PCINT 0 IS THE CENTER OF MASS OF BODY 1 C0407800 

RBlC(N) =.TRUE. IF SCDY. N A RIGID UR FLEXIBLE BODY C04C7900 

•FALSE. IF EODY N A POINT MASS C0438000 

PCCN(N) =TCTAL NUMBER OF RIGIDLY CONSTRAINED ROTATIONAL C040810C 

DEGREES OF FREEDOM AT HINGE POINT N-l CF BODY N C04D8200 

XMA'I M = TCTAL MASS CF ECDY N AND ALL IMBEDDED W HEELS (IF ANY) C0408300 

• < C 0408400 

C - LELtTE THESE 2-CARCS.IF SOOY - N A PCINT MASS C04Ce500 

X I ( I . J, N) =INERT IA TENSUR OF BODY N a I TH ALL DESPUN WHEELS. C0408600 

. INCLLDEC ( IF ANY ) ABOUT ITS OWN CENTER CF .MASS. AN C C0406700 


C04Ce500 

C0408600 

C0406700 


RELATIVE TC THE BUOY N FIXED REFERENCE FRAME, IF BODYC04C8800 


N IS FLEXIBLE INPUT INERTIA TENSOR IN UNOEFCRMEC 
ZERO INTERNAL STRESS STATE _ , 


C04C6900 
C 04 09000 
C 0 4 09 l 00 
C0409200 
C040930C 
CO 409400 


.E - CELETE THESE 2 CARDS IF 6UD Y N A POINT MASS , C0409200 

XM1( I *J.NI-=TRaN SFOR MAT ICN. MATRIX WHICH TAKES VECTORS FRCM ’ THE C040930C 

BODY N TO THE EODY JCCMN) FIXED REFERENCE , FRAMES C0409400 

FCR ZERO RELATIVE ANGULAR ROTATION . BETaEEN TIE ECC IES CO 409500 
IF B CD Y N IS A PUINT MASS THE BODY N FIXED REFERENCE CC409600 
FRAME AXES' ARE RESPECTIVELY PARALLEL . TO THCSE OF. THE CC409700 
BODY JCCN(N) FIXED REFERENCE FRAME . C0409800 

IF BODY N IS A FLEXIBLE 30DY, IT IS ASSUMED TO BE C04C9900 

clamped in translation and rotation at the origin co4iodoo 

CF THE BODY N FIXEO REFERENCE FRAME. C04I0I00 

C0410200 
C041 0300 
C 0 4 1 0400 


F - ALWAYS READ C0410300 

CA ( I .N1 =CENTER OF MASS VECTOR COMPONENTS OF THE VECTOR FROM C0410400 
THE HINGE PCINT N-1(URIGIN UF BOCY N F I X ED REF ER t N CE ) CO 4 1 0500 
TC THE CENTER CF MASS OF ; BODY N (UNDEFORMED POSITION C0410600 
IF B 00 Y N FLEXIBLE) RELATIVE TC BODY N FIXED C04I0700 

REFERENCE FRAME. FUR N=I CA(I.N)=0 1=1. 2. 3 SINCE BY C0410800 

DEFINITION THE HINGE POINT OF EODY 1 IS THE CENTER C0410900 
• - OF MASS OF EODY l M.AM. T’S-P * iC0.4I1000 


IF BODY N FLEXIBLE) RELATIVE TC BODY N FIXED C04I0700 

REFERENCE FRAME. FUR N=t CA(I.N)=0 1=1. 2. 3 SINCE BY C0410800 

■: . . .. DEFINITION THE HINGE POINT OF ECDY 1 IS THE CENTER C0410900 

• - OF MASS OF EODY l 3 , 8 IT, i’.S • JITY «! i. -■> jCO.41 1000: 

' ' COMllOO 

■ »c - always read , . , -C04i 1200 

30ETI403 C3( I.N)=HINGE VECTOR. COMPONENTS OF THE VEC T 0^> f£P M i; H J N£.E C04U300 

POINT JCOMM-1 TU HINGE POINT N-l RELATIVE. ;T0 ; :TFF . C0411400 

BUOY JCCN(N) FIXED REFERENCE. FOR N= 1 IT IS TFE C0411500 

VECTOR FROM THE INERTIAL ORIGIN TO TFE CENTER OF C0411600 

C MASS CF BUOY 1 .WHICH IS THE INGE POINT OF BODY I ; .. C04I1700 

C- RELATIVE TO THE INERTIAL REFERENCE FRAME. , - C041 1800 

C C 041 1 900 


A-20 



n n n n o n n n n n n n n n n n n n .n n n n n n n. r> n- n n n n o n ri.n n n n n n n n n n n ri' n n n 


(p Ci J . 

c 

c 

c 

c 


R - AlwAYS READ INNO.NE.O) 

MESS! JJ =M£SSAGE TO EE PRINTED 
PLMIJ=SPIN INERT 1 A OF WHEEL 

S - ALWAYS READ INMC.NE.C) 

THAW! I )=IN ITIAL WHEEL ANGLE 
THAWCI 1)=INITIAL WHEEL RATE 

. T - ALWAYS READ 

' H=INTEGRATICN STEP SIZE 

timeno=time at, which run is 

IOC FORMAT I l 5) 

I ' ‘N’O'l F0RMATILS.2I&,.C15.5> 

10 2 FCHMATI3D15.5) 

1 0 A FGRHAT(I5.3D1S.5) 

••••*10 5 FORMAT! 1 5i-IBA4> i 

fc"FORM AT I C 15.5 . l CAA') 


IMPLICIT R£AL*6< A -H.O-Z. 1 1 
LOGICAL FGI , FG2. FG3 • EGA ■ FG5, 
LOGICAL NSTAR-T, LR T APE 


C0A1 2000 
C0A12100 
C0A1 2200 
CO A1 2300 
1 C0A12AC0 
CO A 1 2500 
CC A126C0 
C0A1 2700 
COA 1 2800 
CO A1 2900 
CC A1 3000 
00 Al 31 00 
CCA1 3200 
JCGMN) 00 Al 3300 
CO Al 3AOO 
C0A1 3500 
C0A1 360C 
CO Al 3700 
C 0 A 1 38 00 
CO Al 3900 
CC414000 
C04I 4100 
C04142CO 
CO 41 4300 
CC Al 4400 
CO A 1 4500 
C041 4600 
C0414700 
C041 4800 
C0414900 
C0A1 5000 
CO Al 5 1 00 
C0415200 
CO Al 53 CO 
C 0 4 1 5 A 00 
CO 41 5500 
CO 41 5600 
C041 5700 
0041 5800 
00415900 
C0416000 
C0416100 
CC41 6200 
C041 6300 
CO Al 6 A 00 
C0416500 
CO A16600 
C041 6700 
C0A16800 
CC416900 
C041 7000 
C 0 A 1 7 1 00 
COAl 7200 
.) CC417300 

C041 7400 
0041 7500 
COAl 760C 
CO AI7700 

INERF, RBLO, LEOU. LINIT(l) C0A17800 

CC41 7900 


H. - RC AC 

uNL Y 

IF 

3 

DEGREES 

CF 

RELATIVE 

FREECCM 

AT 

HINGE 

PCI NT 

1 - READ 

CNL Y 

IF 

2 

DEGREES 

CF 

RELATIVE 

FREEDCM 

AT 

HINGE 

POINT 

S - READ 

ONLY 

IF 

1 

DEGREES 

CF 

RELAT I VE 

FREECCM 

AT 

H I N GE 

PC I NT 

K - RE AC 

• UNL Y ' 

IF 

C 

DEGREES 

CF 

RELAT I VE 

FREECCM 

AT 

H INGE 

PC INT 


CFII.M)=COMPCNENTS CF FREE COORDINATE VECTOR M 
0 L C I * L ) =CCMPCNEM S CF LOCKED C CURD I NAT E VECTOR L 
THAIMJ— RELATIVE DISPLACEMENT ABOUT OR ALONG OF ( I , M ) 

ThACI M) =RELATI VE RATE CF DISPLACEMENT AEQuT OR ALONG QFtl.MI 
' ' FfiEE AND LOCKED CUORINATE VECTORS ARE INPUTTED 

RELATIVE TO. THE BODY FIXED FRAME IN WHICH THEY 
' ARE’flXED. when FIXED IN BOTH BODY N AND BCDY 
THEY ARE INPUTTED IN BODY JCCN(N) CCCRDI NATES 

L - ALWAYS READ 

FCCN (NdUC+1 ) =NUMBER OF CONSTRAINED DEGREES CF TRANSLATIONAL 
FREECCM. FCR. TCTA|_ SYSTEM 

M - READ ONLY IF 3 DEGREES CF TRANSLATIONAL FREEDOM FDR SYSTEM 

N - READ ONLY IF . 2 DEGREES CF TRANSLATIONAL FREECCM FOR SYSTEM 

C - RE AC ONLY IF 1 DEGREES CF TRANSLATIONAL FREEOCM FOR SYSTEM 

THAC(M)=INITIAL translational rate along inertial AXIS 1 

THADtM+1) =,INI T IAL TRANSLATIONAL RATE ALONG INERTIAL AXIS 2 

THAO! M+2) = INI T IAL T F A N SL A T I UN AL RATE ALONG INERTIAL AXIS 3 

F - ALWAYS READ 

, nmo=tctal number of symmetric wheels 
c - ALWAYS READ INMC.NE.C) 

MCII)=BODY LABEL CF ECDY IN WHICH WHEEL I IS IMBEDDED 
HM( J. I) =COMPCNENTS CF A UNIT VECTOR ALLNG WHEEL SPIN AXIS 
IN BCCY MCI II FIXED COORDINATES 


WITH WHEEL I 
1 


CATA ECHO 


TO BE ENDEC 


• >> i L»„ HJi J 


■AJ.I H- (•/.;! * 1 
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u 0 


CC418000 

co 4 1 a i oo 

IN1ECEH CO 4 l 82 0 0 



* AlftCRK 

t CTI 

• 

CT2 

, C T 3 


CT4 

. CT 5 

. 

FCCN 

. PC ON 

. 

CO 41 8300 


■ * SCNCGF . SCN 

• 

SCR DU M • SCR 


SFKDUM. SFK 

. 

SFR 

• SG 

. 

C041 8400 


* S I 

• S 1 G 

• 

SIXDUM, SIX 


SKOUM 

. SK 

. 

SL 

* SLK 

. 

C04i esoo 


* SMA 

• SMC DU M » 

SMC 

• SM V 


SOK 

• SPIDUM, 

SPl 

. SQF 

. 

CC41 8600 


* SCL 

• SR 

• 

S SCN 

. SS IX 


SVA 

. SVG 

. 

SVD 

• SV I 

« 

C041 8700 


* S VM 

. SVP 

• 

SVU 

• SXM 


SXT 

. TCRQ 

. 

SMAL 

. SEU 

• 

C041 8800 


SC 

. SCG 

• 

NFL XB 

. SFLX 


SFXM 

» NMGDS 

. 

SFCC 

. see 


C041 8900 


> I IN I T ( 

1 ) 

• 

I2INITO) 


SC 






CC41 9000 

c ■ 













C0419100 

c 

f fiE AL*a 












CO 41 9200 
C041 9300 


* ANCC 

(33) 

• 

CNF 

<2,10 

• 

ETIC 

(3.101 

• 

E T MC 

(3.101 

. 

C041 9400 


* FLQ 

(3,20 ) 

• 

FLE 

(2.3.201 

• 

FLH 

(3.3 .20 ) 

. 




C041 9500 


* THACD. 

( 33) 

.* 

YMC.D 

(2.2.11 I 

• 

R INIT 

(I ) 

. 

HZIN IT ( 1 ) 


C 04 1 9600 

c 













C041 9700 

c 













CO 4 1 9 80 0 


CCMMC N 

/CHCK S/ 



N S T Art T 

• 

LRT APE 





C04 1 9900 

c 












.. - 

C042000C 

c • 













C0420 100 


• CO PMC IS 

/LUG 1 C/ 

FG1. FG2 • FG3. FG 

A • FG5 

1NEKF . 

ReLui io ) 


C C42020C 

c. • 













CO 42 0300 

C ; ; • 

CG.MMC N 

/ IN TG / 


AteQRK 

( 200 ) 








C0420400 

C0420500 

« >. 

* CT 1 


• 

CT2 



CT3 


. 

CT4 


. 

C0420600 


. * C T 5 


• 

FCGN 

( 23 ) 


JCGN 

( 10 ) 

. 

LCUN 

<22 ) 

. 

C0420700 


♦ MC 

( 10) 

» 

NEl 



NdOD 


• 

NCTC 


» 

CO 42 08 CO 


♦ NFEfi 


» 

NFKC 



NFRC 


. 

NLOR 


. 

CO 42 090 0 


* NMV 


• 

N MQ 



N MQ A 


. 

N S VP 


. 

C 0 42 1000 


NSVC 


• 

PCC'N 

(111 


SO 


. 

SFR 

(33 ) 

• 

CO 42 1 1 00 


+ SC 


• 

SI 

( es i 


S IG 


. 

SL 


. 

CO 42 1 200 


* SLK 

< 33 1 

• 

SMA 

( 1C 1 


SLK 

(11) 

. 

SQF 

(11) 

. 

C 0 42 1300 


♦ SGL 

(11) 

• 

SMV 



SR 


. 

SSCN 


. 

C042 1400 


* SS I x 


• 

SVA 



S V 0 


. 

SVC 


. 

CC421500 


• SVI 


• 

S VM 



svp 

(22) 

. 

SVC 

(33) 


C042 1600 


♦ SXM 

(3.10) 

• 

S XT 



TORO 

<971 

. 

SMAL 


. 

C0421700 

/ 

* SEU 


• 

MQ 



SC 

(33 ) 

• 

SCG 


. 

C0421 800 


♦ NFL >d 


• 

SFLX 



SFXM 

(10) 

• 

NMODS 


. 

C042190C 


,* SFCC 


* 

see 

<101 








C C 422000 

c 













C 0 422 100 

c 

CCNMCN 

/ IN TG Z/ 











CC422200 

C0422300 


* SCNCLM 


• 

SCN 

< 5 1 

f 

SCRDUM 

. 

SCR 

(9 ) 

. 

CO 422400 


* SFKCUM 


* 

sfk 

( 9 1 

• 

S IXDUM 

. 

six 

(9) 

. 

'CO 4 22 50 0 


* SKDLM 


• 

SK 

< 9 1 

• 

SP IDUM 


* 

SPI 

(9) 

. 

C0422600 


* -SPCCUM 


• 

SMC 

( 9) 








C0422700 

c 













C0422800 

c . t 













C0422900 


k CCMMCN 

/Pc AL / 











CO 423000 

- 

•*,CA 

(2,10) 

* 

C AC 

<3,101 


CL M 

(10) 


CCMC 

(3.11 ) 


00423' 100 


/* OCMC 

(2.11 ) 

* 

ETC 

(2.11) 


ETM. 

(33) 


F C MC 

<3.1 1 > 


C 0 42 32 00 

O0E9S.J o9 

i = 5. 0 %iwl?i 

a as 

HO ATT* cl 


HM 

(3.10) 


MMC 

(3.10) 


C 0 42 330 0 


* HKO< 

(101 

• 

PHI 

(3,111 


PLM 

(10) ° 


'OF* A 3 

" ('3 P3 3 1 

• / ** 

-00423400 


* QFC 

(3.33) 

• 

cl 

( 3.22) 


QLC 

(3,22) 


RC MC 

<3,111 


00423500 


* T 


• 




THA 

(33) 


THAD 

< 33 ) 


C0423600 


4 TKACW 

( 10 ) 

• 

THAW 

( 10) 


XDIC 

l 3.3 . 60 ) 


X I 

(3.3,10 


CO 42 3700 


4 X IC 

(2.3, 10) 

• 

XMA S 

(10) 


XMN 

l 33. 23) 


XMT 

(3.3.10) 


C0423800 


4 T LG 

( 23) 

• 

FLA 

( 3,20 ) 


FLB 

(3.20) 


FLC ' 

( 3,20 ) 


C 0 42 390 0 
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n n, ci o . .no 


* 

• F-LD 

13.3.20). 

FL J 

12.3.20) . 

CAO (3. 1C) . XIO 

13.3.10. 

CC424000 

* 

FL I RC 

12.10) . 

F LC RC 

13.10 . 

FLAC 13.20) , FLQC 

1 3.20) . 

C0424100 

< 

FLC K 

120 ) 

ZETA 

120) 

FCF l 3,3 ,40 ) , FCK 

13.40) . 

C04242C0 

* 

T I M £ NO 




’ 


C0424300 








CC 4244 00 





• 

- 


C0424500 


CC NMC N 

/RLALZ/ 





C0424600 

* 

cbccm 

11.3) , 

Cf? 

<3.10 . 

CdCDUM 11.3) . CBL 

13,10) . 

C 0424700 

* 

XMCCLM 11.1.9) . 

XMC 

12.3.10). 

C 8 N l 3 ) 


C0424800 







” • 

C0424900 








C 0425000 


EQUIVALENCE ILTMI 

1 > * TH AC C ( l ) ) 

.IXMNl 1.1) , ANGD < 1 

> > . 

CO 42 5 1 00 

* 


IXMNl 

1.3). 

YFCD! 1.1,1)) , IXMNl 1 .6 ) ,CNFl I, 

1 ) ) 

C 0425200 

* 


l XMNI 

1.8). 

ET ICI l . 1 ) ) 

. IXMN11 .10) .ETMCI 1,1 ) ) , 

C0425300 

* 


IFLB1 

1.1). 

FL C I 1.1)) 

. IFLE 11.1.1) .FLD1 

1.1.1)). 

C 0 42 54 00 


* (FLH 1 1 . I . I > , FL J < I , l . 1 ) ) 

' * (KOI . L IN I T < 1 ) ) 

* (CdDUMU .1 ) iK2IMT( 1 )» 

* { SCNDLV , IZ IMT ( 1) > 


CINEKSiCN TEM1 ( 3 . 2 ) , TEM2 13 . 3 ) 
IN7ECEW NESSlld) 


iiCAii.n.HiNirun 
. { A*ORKl 1 > , I I N I T ( 1 ) ) 


•2 4 


" b - 
L = 
NBCD 
READ 
Ne 1 
FR IN 
FR IN 
FR IN 
' FR IN 
PR IN 
PR, IN 
FRIN 
F S I N 
FR IN 
READ 
CO 1 
K 1 = 

MESS 
READ 
IF IN 
FR IN 
1 YFE 
REJU 
CONT 
RBLQ 


EGO I EE 


= NLMdER CF 
,10C. NdOO 
= NdCDFl 
I 199 

T 20 C, N BCD 
T 2S4 
T , 2SE . 

T Zbt 
7 2 b 7 
7 2 S E 
7 259 
7 2 2 1 

INPLT FOR EACH BOCY 

K= 1 ,NBOD 

K-l 

;cj) = alphanumeric description 
ios. n, ( wes s ( j ) . j= i . i a) 

•EO.K) GO 70 24 
7 247 
24 7 

rn 
INUE 
(K) 


OF BODY N TO BE PRINTED 


G.»> 


■jiJCCN 
FCCN 
XMAS 
• READ 
. IF (R 
FRIN 
FR IN 


(,K) ; 
IK) 
IK ) 
101 


K RIGID dODY 
K PCINT MASS 
X^fjCH dOD,Y „K ’ 


TRUE IF BODY 
FALSE IF. BODY 

BODY LAE t £L TO X^^CH dOO,Y'„K 'IS ,ATTACH 
NUMBER OF CONSTRAINED AXES AT hinge’ 
TOTAL MASS OF EOOY K PLUS MOMENTUM w 
RUL01 K) , JCONIK ) , PC0N1K) .XMASI K) 

ELO IK ) ) GO TO 2 
T 2 C 1 • K, (MESSI 0 ) • J-l • 18) 

7 2CE ,K, XMASI K) 


D ( AT 
POINT 

HEELS 


HINGE 

K-l 


K — 1 


C 0 425500 
C042S600 
C0425700 
C0425e00 
C 0 42 59 00 
C 0 42 600 0 
C042610C 
C0426200 
C 0426300 
C0426400 
C0426500 
00 426600 
C0426700 
C0426800 
C 0426900 
C C 42 7000 
C0427100 
C0427200 
C0427300 
C0427400 
CO 4 27 500 
00427600 
: C0427700 

CC427800 
CO 42 7900 
C 0 42 8000 
CG 42 8100 
C0428200 
C 0 428300 
00428400 
C0428500 
C042e600 
CC 428700 
C0428800 
CO 428900 
C0429000 
C0429100 
C0429200 
MI 'C0429300 
C0429400 
C0429S00 
C0429600 
C0429700 
C 0 429800 
CO 429900 
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GO TC 3 

■ 




CC430000 



2 

PRINT 2C2 # 

K . (MESS! J) , J x 1 ,18) 




C04301 00 




PRINT 2ce. 

K .XMASIK) 




C 0430200 


c 


>11 I ,J.K>. 

l.J=l,3 = COMPONENTS OF INERTIA TENSOR OF BODY K *ITH 


C0430300 


c 



ALL DESPUN MOMENTUM WHEELS.- in body K 



C0430400 


c 



MASS RELATIVE TC 80DY K FIXED FRAME 




C0430500 


c 



COORDINATES 1 ABOUT THE COMPOSITE 

CENTER 

CF 


C0430600 




FE*D 102, 

ttxl I I • w • K ) »J-=1.2).I~1 .3) 




CO 43 0 700 




PRINT 21G. 

l XI I 1 . J .K> . J = 1 .3 ) . K 




C0430800. 




PRINT £17, 

IXII2.3.K) .3=1.3) 




CC430900 




PRINT 2 IE. 

I XII3.J.K) • J— 1.3) 




C0431000 



2 

CONT INUE 





C043I 100 




IF (K .EQ . 1) 

GO TO 4 




C0431 200 




PRIM 2CJ. 

K , JCON IK) ,K 1 




C 0.43 1-300 




C-0 T C £ 





C0431400 



4 

PRINT 2C4 





00431500 




PRINT 2£2. 

NBGD 




C0431600 



R 

CONTINUE 





C043I 700 




IF l .NOT .RdLO IK) ) GC TO 8 




C0431 800 


c 


XM 7 ( I . J ,K) 

. 1 , J— ) . 3 =. COMPONENT OF TR ANSFORM AT I ON MATRIX BODY 



C0431900 


c 



K TC BODY JCONIK) COORDINATES 

- 



C 0432000 - • 

• - 



PE 40 102. 

I I XMTI I . J.K ) . J=1 , 2 ) , 1 = 1 .3 ) 




CO 432 1 00 ‘ 




GO TC y 





C0432200, 



6 

XM T < 1 . 1 . K ) 

= 1 




C0432300 




XM 1 I 1 ,2 ,K) 

= 0 




004324.00 




XM T ( 1 . 3 ,K) 

= 0 ' 




C0432500 




XMTI 2 > 1 .K) 

= 0 • v * - 




C0432600 




XM T I 2 .2 .«) 

= 1 




C0432700 




>M II 2 .3 .K> 

= 0 




C 0 432 80 0 




XM T( 2 . 1 .K) 

= 0 




CO 432900 




X.M T I = . 2 . K ) 

= 3 




C0433000 




XMTI 2 .3 ,K) 

= 1 




CO 43 3 IOC 



9 

FRINT 219. 

1 XMTI 1 .J.K) .J = l .3) 




C0433200 




PRINT 22C. 

K . I XMTI2.J.K ) . J=1 .3) 




CO 433300 




IF IK . EQ . 1) 

GO TO. 1C 




C0433400 




FRINT 222. 

jccmk).ixmti;,j.k).j = i.3) 




C0433500 




GO TC 11 





CO 43.3600 



1C 

FRINT 221. 

I XMTI 3 i J.K ) . J:| ,3) 




CC 433700 



l 1 

CONT INUE 

t 




C043380C 


c 


CAIJ.K) . J= 

1,3 = COMPONENTS CF CENTER OF MASS FROM HINGE PCINT 

K 

- I 

C0433900 




READ 102. 

(LAI J.K ) ,J=I ,3 ) 




C 0434000 




PRIM 2 C 7 . 

CAIJ.K), K , 




C C 43 4 100 




FRINT 2CE. 

KI.CAI2.K) 




C0434200 




PRINT 2C9 . 

K .CM 3 .K) 




C0434300 


c 


CBt J .K) . J= 

1,3 = COMPONENTS CF VECTOR FROM HINGE POINT 

( JCCNIK )- 

1 ) 

C 0 43 44 0 C 


c 



HINGE PCINT K-l IN 30DY JCGNCK) COORDINATES 



C0434500 




FE4D 102, 

icei j .k ) , j=i ,3 ) 




C043460C 




IF I K .Nt . 1 ) 

GO TO 6 




00434700 




PRINT 2 1 C . 

CB(l.K) 




C0434800 



j 

PRINT ill* 

Cd< 2.K ) 




C C 43490 0 




PRINT 212. 

CB< 3.K ) 




C043500C 




C-0 TC 7 





C0435I0O 


f 

t 

K2 = JCCMKI-1 




CC4352C0 



f ' 

•PRINT 212. 

CB( 1 ,K ) ,JCCN< K ) 




C0435300 




FRINT 214. 

K2.CBI 2 , K ) 

>. = ■: * 

•v*: » 

4 J 

:C0435400 




PR IN T 2 1 E » 

K 1 , CB< 3,K > 

- 



C0435500 

/ 


.7 

CONTINUE 





C 0 435600 


c 







C0435700 


c 


REAC'lN FREE AND LOCKED COORDINATE VECTORS ALONG WITH 

INITIAL 

CCNDC0435800 




IF IK .EQ . 1 ) 

GC TO i2 



- 

C04359C0 


A-24. 









n n 0 v no'. ' no • no 


F = * ♦ 2 - PCCN( K-l ) 

L = L + FCUN (K-l ) 

12 N1 = F + 1 
F2 = F*2 
LI = LV 1 
• L2 = L+2 

IF(R£LO(K) ) GU TO 20 
IASIGN = 1 

GO TC 21 
2 C IASIGN = C 
2 1 CCNT INUE 

1GCTC = FCCN(K) ♦ 1 

GO TC ( 12 . 14 . I £ . I 7 ) . IGCTC 


FCCMK1 = 0. THREE DEGREES CF FREEDOM 
12 READ 132. ( ( QF< J . I ) . J= 1 . 3 ) . I = M ,M2.2> 

read 102 . 

READ 102. (THAD( I ) .I=M ,M2> 

PRINT 24 t. K 1 
IF (RELC ( K 1 1 GO TC 31 
FCCN(M) = K 
FCCN (M l 1 = K 
GO TC 32 

21 FCCN(F) = JCCN(K) 

CF (I .Ml ) COMPUTED FRCM QF(l.V) AND 0F11.M2) 

FCCMM) = -M HELPS LCGIC IN SUBRCUTINE TRAN VD 
FCCN (M 1 ) = -M 

22 FCCN ( F 2 ) = K 

FRINT 22E. OFl 1 ,M) ,QF( 1 . 02 » 

PRINT 229. M .OF (2 .M ) ,M2 ,0F (2 ,M2 1 
IF(K.EQ.l) GO TO 29 

■ PRINT 22 C . FCOMM ).UF(3.F) .FC0NCM2) ,OF(3,M21 
GO TC 30 

29 FRINT 222. CF < 3. F ) .FC0NIM2 ) .QF (3. M2 ) 

3 C CONTINUE 

FRINT 2 £ 2 . Ml 

IFdASIGN .EC. 0 ) PRINT 224 
IF ( 1ASIGN .tC. 1 ) PRINT 243 
FRINT 22 E . ( I.THA(I). .1 ,TFAC(I) .1 =M . M2 ) 

FR INT 22 t 
GC TC 1 


FCCN IK 1 = 1. T*0 CEGREES OF FREEDOM 

14 READ 102. ( ( QF( J , I ) , J= 1 .3) . I =M .Ml » 

. *READ 132. THA(M) ,THA(M1 ) 

READ 102. THADIM ) .THACI FI ) 

PRINT 227, K 1 
IF (RELUIK) ) GC TO 23 
FCCN (Ml = K 
FCCN (FI ) = K 
LCCN (L ) = K 

• .GO TC 3 4 

32 FCCN(F) = JCON(K) 

AFf>CF.,CCN (Ml ) = K 

CL(I.L) COMPUTED FROM OF ( 1 . F ) AND OFIl.Ml) 
LCCN (LI = — F HELPS LOGIC IN SUBROUTINE 
LCCNILl = -M 

34 PRINT 22fc. QF(l.M), QF ( l ,M 1 ) 

PRINT 229. M .QF(2 ,F) .Ml . CF (2, Ml > 

IF(K.EG.l) GO TO 35 


'* * t 7j j 3 c 

TRANVD 


7i, ( J b j 


C0436000 
CO 43 61 00 
CO 436200 
CO 436 300 
C0436400 
C0436500 
C0436600 
C0436700 
C0436800 
C0436900 
C0437000 
C04371 00 
CO 43 72 00 
CO 437300 
C0437400 
C0437500 
C0437600 
CO 43 77 00 
C0437800 
C0437900 
C0438000 
CO 43 8100 
C0438200 
C0438300 
C0438400 
C0438500 
C0438600 
C0438700 
C 04388.00 
C0438900 
C0439000 
C0439100 
C0439200 
C0439300 
C0439400 
C0439500 
C0439600 
C0439700 
C0439800 
CC439900 
C 0440000 
CO 44 0 100 
CO 44 0200 
C0440300 
C0440400 
C0440500 
C0440600 
CO 440700 
C0440800 
C0440900 
CC441000 


CO 44 1100 
CO 44 1200 
” 15 * 1 '•(30 441 300 

C 0 44 1 400 
C0441500 
C0441600 
CO 44 1700 
0044 1 800 
00441 900 
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PRINT 22C. FCCMM > . OF ( 3 , ► > . FCONI *1 » .OF13.MI ) 

■ . GO TC 3 £ 

- 3E PRINT 222, CF ( 3 . N ) . FCQM MI ) .OF ( 3 . M 1 ) 

3£ COM I Not' 

PRINT 22 1, L 

IF(IHSIGN .EG. 0 ) PRINT 224 
IFIIHSIGN .£0. 1 ) PRINT 243 
PRINT 225. . < I . THA ( I ) . I .TFAD ( I > ,I=M.Ml ) 

PRINT 22 £ 

• CC TC l 
C 

C : .RCCN(K) = 2 CNE CfcGREE CF FREEDOM 

1 2 RE 4 0 102. (GF< J.M).J=1 .2) 

RE HO 102. (CjLCJ.L ) .J — 1 .2 ) 

• RE HD 102 . THA (M ) 

; RE HD 102. THAC(M) 

, . PR INT 222, K1 
. . , IF ( RElU IK > ) GO TO 37 

• FCCMM) = N 

LCC NIL 1 - K 

• LCCNIL 1 ) = K 
• - . CD TC 26 

37 FCCMM) = JCCMK1 

LCCN (L ) = K . 

' . LCCN (LI) = K 

•' ' 3 E - PR INT 222, QF(l.M) 

. PRINT 224, M,0F(2iM) 

IFIK.EO.l) GO TO 29 

PRINT 2 J £ , FCON(M), 0F(3.M) 

GO TC 40 

. 39 PRINT 2Cfc. UFIJ.MI 

4 C PR INT 2fc9. OL( 1 .L ) 

.. PR INT 27C . L . OL ( 2 ,L> 

, , i- PR INT 271. LCCMU.QU3.L) 

PRINT 221, Ll 

IFIIHSIGN ,EU« 0 ) PRINT 224 
IFdHSIGN .EG. 1 > PRINT 243 
PRINT £.2 2 , M , THAI M) , M , THHC(M) 

PR INT 22C 
CO TC 1 
C 

C. . FCCN(K) - 3. 2ERC CEGREEJ CF FREEDOM 
1.7, READ' 102, ( ( QL ( J. I ) . J = 1 .2 ) . I=L ,L1 ) 

PR INT 272. K. 1 

, LCCNIL) = K , 

LCCN <L 1 ) = < 

LCCN (l2 ) = K 

PRINT 22C , QL(l.L). QL(l.Ll) 

PRINT 227, L .OL< 2 .L ) ,L l ,OH 2 .L 1 ) 

_ ■■ FRINT 22t. LCOML ) .QLI3.L) .LCJN1LI ) . OL( J , L 1 ) 

..."PRINT 221. L2 
PRINT 2 2 t 
,1 . CCNT INLE 

0>?ELdH0 3* , . , r .... ,. 

C READ IN TR ANSL AT I CN AL VELOCITY CONDITIONS F OR r ,H 1 NGE , PC I NT. 2EPC 

C , RELATIVE TO INERTIAL ORIGIN 

READ 1 3 C , PCCN(NBCC+l> 

, NFfi = .(♦2-PCON (NdCD) 

NLR = L+FCQNINEOO) - l 
'• PR INT 244 I 


CC 442000 
CO 442 100 
C 0442 200 
C 0442300 
C0442400 
C0442500 
C 0442600 
CO 442 700 
C044280C 
CO 442900 
CC 44 3 000 
C0443I0O 
C0443200 
CC 44 3 3 CO 
C0443400 
CO 44 350 0 
C0443600 
C 0443 700 
C 0 443 8 00 
C0443900 
C0444000 
C0444100 
C0444200 
C0444300 
C0444400 
C0444500 
C0444600 
CO 44 4 700 
CC44480C 
C0444900 
CC445000 
C 6 44 5100 
C0445200 
CC445300 
C 0 44 5400 
C 0 44 5500 
C 0 4456 00 
CC445700 
CC445800 
CC4459C0 
C044600C 
CO 446 I OC 
C 04462 CC 
C0446300 
• C0446400 
CO 44 6500 
CO 446600 
C044670C 
C0446800 
C C 446900 
CC447000 
'■ A ' CO 44 7 1 00 
C044720C 
' CO 44 730 0 
. .CO 44 7400 
C 0 44 750 C 
C C 44 7600 
C 0 44 77 00 
C044780C 
CC 44 790 6 
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print 2 ec . pcun inbcd+i ) 

13 = J-FCGNl NBQDH ) 

IF ( I 2 •— C .0 > GO TO ^5 

c compete initial displacement jf hinge point zero from ceui 

c input ing this hollo ee recundant infurmaticn 

C CO IE. I=NFR .NFS* 13- 1 

ITES1=NFK*I j-l 
IF ( I 1ES I .LT . NFR ) GO TU 5CCC 
CO IE i=NFR* 1TEST 
16 THAI I ) = Ci3I 1+ 1-NFR . 1 ) 

50 3 C CONTINUE 

'RE AO 1 22 .< THADI I ) . I=NFR , I TEST) 

PRINT 2tl 

print 242 

print 225 . I I .THAI I ) . I . THAC I I ) . I =NFR, I TEST) 

PRINT 253 
GO TC it 

25 PRINT 2 4 6 

26 PR INT 264 

’ CO 22 1=1.3 

IF ( I «GT . 13 ) GO TO 23 
CBM I) = 0.00+00 
GO TC 

‘ 25 CBM I ) = Cd( I. 1) 

22 CONTINUE 

PR IN T 265 ’ 

PRINT 266 

PRINT 267 

NFER = NFR+I 3-1 

NL OR = NLR+P CON ( NBCD + 1 ) 

PRINT 253 
PRINT 24S. NFER 
PRINT 25C.NLOR 
PR IN T 226 
C 

C RE A 0 IN ROME NT UM HHEEL DESCRIPTION 


C . 

READ 133. NMC 
IFInMC.EC.O) GO TC 50 
FRINT 22S. N MG 
CO 16 I- l, NMD 

PE A 0 134. Mol I ). (RMJ. I) .3=1.3) 

PEAO 136. PLMI I ) . I MESS! J) , J = t * 16) 

PE A 3 132. THAk(I) .THADKl) 

FRINT 265. I . MO ( I ) , I MESS <J) » J = 1 .16) 
PRINT 274. HM(l.l).MOII) 

PR INT 275. H M ( 2 . I ) 

PR IN T 2 76 . I , H M ( 3,1) 

PRINT 2 c 6 , PLM ( I ) 

PR INT 2 6 C . I 

,,, v '.' PRINT 26 1. I , THAo I I > 

PRINT 262, I.THAOMI) 

PMCMII) = PLMI I ) * TPADWt I ) 

. , PRINT 264. NMCMtl) 

''.’“'''jfll 1/2 )*2 '.EQ'i'i ) - "GO* TO^'i 5 fc ^ C ' J ’ ’ r *'"‘ ’’’ 
FP INT 252 
FR INT 252 
GO TC 16 

15 PRINT 226 

1 6 CON T INoE 


i 


v- I 30J ~v .36 23 r TA.J2HARI - 


C 0 44 80 00 
CO 44 6100 
C0446200 
CC44630C 
C0448400 
C C 44 85 00 
C0448600 
C0448700 
CC448800 
CC 44 8000 
C C 44 9000 

co44s ido 

C0449200 
C 0449300 
CC449400 
C0449500 
CO 449600 
CO 44 9 700 
C0449800 
C 0 44 99 00 
CC450000 
C0450100 
CC 450200 
CO 45 030 0 
C0450400 
C0450500 
■ C 0 45060 0 
CO 45 0 70 C 
00450800 
C 0450900 
C0451000 
C0451 IOC 
C 3 45 120 0 
CO 45 1 300 
CO 45 1400 
CO 45 1 50 C 
C 0 45 160 0 
C045I 700 
• C045180C 

CC451SOO 
C 0 45 200 0 
CC452100 
CC45220O 
C 0 452 3 CO 
CO 45 240 0 
CO 452500 
C 0 45 260 0 
CO 45 2 700 
C0452800 
C0452900 
w '* CO453C0O 
C0453100 
C0453200 
C0453300 
’’ C045340C 

C 0 45 350 0 
C04536C0 
C0453700 
CC45380C 
C 0 45 390 0 
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5 C CONTINUE 

READ IN INTEGRATION STEP SIZE 
READ 102 . H. TIMEND 
PRINT 252 
PRINT 272. H 
PRINT 2E2 
PRINT 2E5. T I REND 
IOC FORMAT (15) 

101 FORMAT (l5 .2 15 .01 5.5 ) 

102 FORMAT (3015.5) 

102 FORMAT (2L5) 

104 FORMAT (15.3015.5) 

1 05 FORMAT ( 15. 1 BA4 ) 

106 FORMAT (C15.5.16A4) 

199 FORMAT! • I • .20(7) ) 

2 0 C FORMAT (22X. 'INPUT DATA FOR *. 
ATS MIST EE USED) • ./ ) 

201 FORMAT (EX, 'BODY NUMBER*. 13.' 

202 FORMAT ( 5X , • BODY NUMBER', 12.* 


C 0454000 
CO 454 10 0 
CO 454 2 00 
C0454300 
. CO 45440 0 
00454500 
CO 454600 
C 0 454700 
C0454800 
C 045490 0 
C0455000 
CO 45 5 10 0 
CO 455200 
C0455300 
C 0 4554 0 0 
C0455500 

13.' BODIES (A CJNSISTANT SET OF UN1C045560C 

C 0 455 700 

(POINT MASS) • . 13A4. /') C0455800 

(RIGID BODY) ' , 1BA4.7) C0455900 


202 FORMAT ( 10X. 

I ./ ) 

204 FORMAT (10X. 
♦INTERTIAL SPACE 

205 FORMAT ( 10X. 

*2. • CP ECOY' 

20E FORMAT (1CX. 


2oe 

FORMAT 

( iox. 


* IN ATES) 

• ) 

2 0 £ 

.FORMAT 

( iox. 

21 C 

FORMAT 

i iox. 


* • ) 


2 l 1 

FORMAT 

( 1CX. 


* INATES) 

■ ) 

2 1 2 

FORMAT 

I IOX, 

21 J 

FORMAT 

( IOX, 


FI>EO 

• ) 

2 l 4 

FORMAT 

i iox. 


* INATES) 

• ) 

215 

FORMAT 

( 10X, 

21 e 

FORMAT 

( 2oX . 

2 i 7 

FORMAT 

I 10X. 

21 8 

FORM A T 

I 26X , 

2 1 <5 

FORMAT 

( tox. 


1 EL AT I VE 

• ) 

22 C 

FORMAT 

< iox. 

22 l 

FORMAT 
* S • .// ) 

( iox. 

222 

FORMAT 

( IOX, 

223 

FORMAT 

( 12 X , 

224 

FORMAT 

( IOX, 


* C ) * * ✓ ) 


225 

FCRM AT 

( 15X , 

226 

FORMAT 

I * 1 * ) 

227 

FORMAT 

( iox. 

226 

FORMAT 

( iox. 


♦ • *D 12 • 

5 ) 

229 

FORMAT 

( icx. 


BODY*. 13.' CONNECTED TO dUDY'.IJ.' 


COMPONENTS CF VECTOR FROM 

INERTIAL ORIGIN TO CENTER 

OF NASS CF ECCY l 
COMPONENTS CF VECTOR FROM 

HINGE POINT*. 13,' TO HINGE 


AT HINGE POINT* .I2C0456000 
CC456100 

CENTER OF MASS OF BUOY l CAN TRANSLATE AND ROTATE IN C0456200 
) C 0 456300 

MOTION CONSTRAINED AdOUT'.IJ,* AXES AT HINGE PO I NT • , I CO 4564 00 
13,/) CO 456 50 0 

TOTAL MASS CF ECOY *.12,* =*.011.5,* (M) *,//) C0456600 

2C7 FORM A T ( 1 OX. • COMPONENTS CF VECTOR FRCM ' .015.5.' ( BOCY *. 13 . CO 456700 

*• FIXED •) C0456800 

HINGE POINT*. 13.* TO CENTER *.015.5.*, CO0RDC0456900 

C0457000 

CF MASS CF ECCY * . 1 3.1 1X.D1S.5 . 10X, • (L ) • ,//) . C0457100 

'.015.5. ' (INERTIAL C0457200 

C04573C0 

• .015.5. * COORD C0457400 

C0457500 

• ,D 15.5. 10X, • (L) • ,// ) C045760C 

*.015.5.* ( EJOCV • , 13, CC457700 

C045780C 

*,015.5.* COCRD CO 457900 

CC458000 

POI NT* . I 3 .21X .015.5. 1 OX, • (L ) • ./✓ ) . C0458100 

012.5.* BCDY',13.* COORDINATES •> C0458200 

INERTIA TEN SGR =*,3012.5.' UNITS •> CO 45830C 

012.5 ,5X ,*( N*L**2 ) './/) CC458400 

TRAN SFCRMAT ICN MATRIX • , 3012.5.5X, ^DEFINES NOMINAL RC0458500 

■ ' -• CC458600 

BCCY • , I 3 . • TC =• ,3012.5 . 1 2X . • OR IENTAT ION •) C0458700 

INERTIAL * , 3D1 2 . 5, 7X . • OF BODY FIXEC AXECC458800 

, • CC45B900 

BCCY * . 13 ,13X, 3012.5.7X. *0F BODY FIXEI) -AXES'.,//) -..C0459C00 

I NER T I ALLY • ,9X ,D1 2 .5.6X . • IN BODY ' . 13 . 1 0 X , D 1 2 . 5 , // > C0459100 

INITIAL CONDITIONS ABOUT FREE- AXE S < R AO , R AO /SE CO 4592 0 0 

. ‘ . C0459300 

T HA ( • , I 2 , • ) =',012.5, • IHADC*. I2.'* )'=!'.012.5) ' '-C045940C 

. C0459500 

TWO CEGREES OF FREEOCM AT HINGE POINT *,13./) ' C0459600 

COMPONENTS CF FREE • , 01 2 .5 .6 X , • COMPONENTS OF FRE E C04597C0 

C0459800 

VECTOR *. 13-.* FIXEO = • , D1 2 . 5 . 6 X , • VECTOR*. 13.* PIXC0459900 
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* EC = • ,D12 .5 > 

23C FORMAT (IOX,* IN t'CDY * . I 3 . 1 CX .Ol 2. 5.6X . • IN 
221 FORMAT ( IOX, 'COMPONENTS CF LQCKCO VcCTOR'.I 

* E Y VECfCR CROSS PRODUCT *,//) 

-222 FORM A T 

232 FORM A T 
224 FORMAT 

235 FORMAT 

236 FORMAT 
■-' * • .0 12 . S ) 

237 FORMAT ( 10X, 


C 0460000 

BODY *.I3.10X,D12.5.//)C0460100 
«* DEFINED INTERNALLY C0460200 

CO 460300 

( 10X. 'ONE CEGREE CF FREEDOM AT HINGE POINT*. 13./) C0460400 

1 13X, 'COMPONENTS CF FREE *,D12.S> C0460500 

<10X,' VECTOR*. 12,* FIXED ‘=*,012.5) C0460600 

(10X.* IN CODY * . I 2 . 1 CX . 01 2.S. // ) C0460700 

( 10X. 'COMPONENTS CF LOCKED * . D 1 2 . 5 . 6 X . • CQMPONE NT S OF L CC KED C C460800 

C C460900 

VECTOR*. 12,* FIXED =• .012. 5. OX. • VECTOR*. 13.* FIXC0461 00C 


* ED = 

2 3 £" FORMAT 

FORMAT 
FCRMAT 
FORMAT 
FORMAT 
FORMAT 

* * . / ) 

244 FORMAT 


239 
24 C' 
24 1 
242 
243- 


• .012.5) 

(10X.* IN ECDY * . 12 . 1 CX . Ol 2. 
(SOX, 131* NCMENTCM AHEELS 
( 1CX. 'MOMENTUM AFEEL'.IJ.* 


5.6X . • IN BODY * . 13, 
IN SYSTEM* .// ) 
EMBEDDED *.012.5, 


CO 46 1 1 00 
10X.C12 •£,//) C0461 200 
C0461 300 
* UN IT S • ) CC 4tl 400 


( 10X. 
I 10 X , 

( iox. 
( iox. 


IN ECDY *,13.* 
F l XEE IN BODY 
INITIAL 


. COMPONENTS = ' .012.5. * 

.13,.* » ,012. b,// > 

CCNDITICN5 ALONC FREE AXES IL.L/T) 


TRANSLATIONAL CJIVDITIENS ON CENTER CF MASS CF B CD Y 

♦ RELATIVE TO I NER T I AL 1 CR I G I N ' ' ) 

24E 'FORMAT (10X.5X.IJ.* FREE DIRECTIONS OF T R AN SL AT I CN . P AP ALLEL 

♦ ,K INERTIAL AXES RESP './/> 

2 4 £ FORMAT (IOX, 'THREE DEGREES CF FREEDOM AT HINGE POINT*, 13,/) 

•247. FORMAT (* I NPCT ERROR IF CATA CARDS. BODIES OUT UF SEOUENCE 

♦ SDS MISSING FROM PRECEFD ING BODY CARDS •) 


L*F»T* ) C C 46 I 500 
C0461 600 
C046I700 
C0461 800 
1 C0461 900 
C C 462 000 
C I . J CO 46 2 1 CO 
C0462200 
C0462300 
CR C A CO 462400 
CC462500 


248 FORMAT (IOX,* TRANSLATIONAL MOTION CF BODY 1 t.M. C CN ST R A INR C AL ON C 0 462 6 C 0 
*G ALL THREE INERTIALLY FIXED AXES *.//> '* C0462700 


245 FORMAT ( IOX, • 
•EDCM *.//) 

2 5 C FORMAT (IOX, • 

♦ S CF FREEDOM 
25 1 FCRMAT ( IOX, • 

' *TEC • ) 

252 FCRMAT ( IOX, • 

* .'COMPUTED * ) 


ENTIRE SYSTEM FAS*. 13.* UNCONSTRAINED DEGREES CF FREC0462eOO 

• ’ ! CO 462 900 

SYSTEM HAS*. 13,' LOCKED OR CCNSTRAINEC C EGREE C C 46 30 OO 

C04631 00 

IUT OR ALONG FREE VECTOR * .12,* CC MPU CO 4632C0 

C 0 463 3 00 

CONSTRAINT TCfiCUC ABOUT OR ALONG LUCKED VECTOR *.I2 C046340C 

C0463500 


ENT IRE 
.// ) 

D I SPLACE MEN T 


25 2 

format 

(2( /) ) 

■ • 






CO 463 6 C 0 

25 4 

^FORMAT 

( 25X, • 

( GUANTI TY > 

• 

t 6 X , * ( ENGLISH) • 

,9X . • 

(SI ) • , 9 X , • (SYMECL )• 

) 00 46 3 70 0 

255 

■FORM AT 

( 25X. • 

LENGTH 


*6 X , • 

FOOT • 

,UX , • 

METER * . IOX. * L • ) 

C 0 463 8 00 

2 5 € 

FO R M A T 

( 25X. • 

FORCE 1 


• 6X 

POUND • 

. ax . * 

NE*TON * . IOX. *F • ) 

00463900 

257 

FORMAT 

( 25 X , • 

T I ME 


• 6X • • 

SECOND • 

. dX. • 

SECOND • , IOX. • T * ) 

C 0 464 0 00 

256 

FORMAT 

(2b X, • 

MASS 


* 6X , • 

SLUG • • 

. dX . • 

KILOGRAM • , 1 OX, *M • ) 

C 0 46 4 1 OC 

259 

FORMAT 

( 25X , • 

ANGLE 


# 6 X t • 

RADIAN • 

.ax. • 

RADIAN • , 1 OX . *R * . // ) C0464200 

260 

FORMAT 

( SOX , • 

(MUTICN ccn 

STRAIN 

ED AL C NG 

• . 13. 

* AXES) *.//) 

CO 464300 

2 6 1 

FORMAT 

( 1 5 X , • 

FREE VECTOR 

s aligned With 

INERTIALLY -'FIXED AXES RE SPE C0464400 


1 . ' 1CTIVELY *.///•) 

.. -262 FORMAT ( IOX.* 

♦ CATA ) * . //) 

263 FORMAT C10X, • CCMFCNENTS CF FREE VECTOR*, 13,* DEFINED INTERNALLY 

♦ Y VECTOR CROSS PRCCUCT < ./ ) 

.-0 )2&« vEORMAT irOXiv'.IN’BTIAL ;GCN.C 1‘T-ION S OF 
1TICN MATRIXES COMPETED'* )-> / . • .. ■ 


( TRANSLAT I CNAL CONDITIONS GIVEN AFTER BODY*. 13,* 


ALL DIRECT! ON Ceos I NE 


CO 46450C 
C 0 464 60 0 
C 0 46 4 700 
B CO 464 80 0 
C0464900 
1 R ANSFORM A C 0465000 
CC 465 1 OC 


265 FORMAT. '( 12X. • INTERNALLY FRCM THE TR ANSFOR MA TI ON M ATR I CE S WHICF DEFC0465200 
. : ■ ■•♦. INE FCMINAL RELATIVE*) t \ , * ,C0'4653 00 

• r. '266 '■FORMAT ! ('12XT' ORT E MAT .1 CN r t ZERO I NT ERNAE* -STRESS 'STATE K’-A'ND INITIAL C046S4C0 
♦ CO ND IT I C NS FOP*) ' C 0 46 5 5 00 

267 FORMAT ( 12X. "ROTATION AtCUT- TilE SPECIFIED FREE VECTORS*) C04656CC 

. 268 FORMAT ( 1 1 X, • I NER T I ALLY • , 1 OX ,D 12 .5 . // ) C0465700 

265 FORMAT ( IOX, 'COMPONENTS ' CF LOCKED ’.DI2.5) C0465800 

. 27C FORMAT (IOX, * ‘‘VE C TOR * . 1 3 «"• FIXED =*.012 .-5) CC4659C0 
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27 1 

FORMAT 

I 10X, 

272 

fofm; t 

1 10X, 

273 

FORM A T 

( iox. 


*GR AT ICN 

(FOU 

27 A 

FORM A 7 

( 15X , 


♦ fcD • ) 


2 75 

FORMA T 

♦ 1 ) 

( 15X , 

276 

FORM A T 

( 15X. 

2d C 

• FORMAT 

( 25X . 

■28'1 

FORM AT 

< sox. 

26 2 

• FORMAT 

(Z9X, 

264 

FORMAT 

*C * . / ) 

< 10 A. 

265 

‘ FORMAT 

< i ox. 

2 dd 

FORMAT 

( I0X, 


• IN BODY* . 13,1 CX, 012.5. //> 

•ZERO DEGREES LF r«E£DC A* AT rilNGc POINT*. 13./) 
•INTEGRATION STEP SIZE FUR PIXEL STEP RUNGE KUTTA 
RTh ORCER > •= * .0 12.3) 

•COMPONENTS CF Ulf VECTOR *.012.5 


(BODY • .13. 


ALONG SPIN AXIS OF 


=* .012.3. 


CGGfiCI NA TE S 


13,/) 


• ' »FEEL * . I 3 . 16X ,012.5.// ) 

• INITIAL CONDITIONS FUR WHEEL. 

•THAil *. 12, • ) = *.012.3.* RAO*) 

• THAO »< * . 12 . * I = *.1)12.5,* RAD/SEC *./) 
•ANGULAR MOMENTUM AdUUT SPIN AXIS =*.D12.5. 


MENTUM XPEEL * , I 3, * EMBEDDED 
•ROTATIONAL INERTIA AUUUT SPIN 

»**£*,//) 

2ee FORMAT (lOX.'RIGIC BUOY CR GYROSTAT NUMBER* 


CC46600C 
C04661 00 
I NTE CC46C200 
CO 466300 
F I X CC 456 4 CC 
CO 4665C0 
) C04666CO 
C0466700 
CO 4668C0 
C0466900 
C C467000 
C04671 00 
M»L**2/SEC0467200 
C0467300 

IN BUOY * , I 3, 5X. 1 6A4, //) C0467400 
AXIS ' .012.5. ■ M *L CC467500 

C C 46 76 00 

. 13 ) 


289 FORMA T( 1 CX ,* PROOF AM 
RETURN 
ENC 


TIME T£RKINATGR=* .D12.5) 


I 


C 0 46 7 70 0 
C 0467800 
C0467900 
C 0 46 80 00 


C ' 

SUERCUTINE INEROR 

c 

c - 

C . INERGR PERFORMS VARIOUS CHECKS ON INPUT DATA TO CHECK 

c fcr basic typing errors in input data anl violations 

C CF SASIC formalism rules 

c 

c THE DEFINED SYSTEM MUST BE PHYSICALLY REALIZABLE. 

C ■ < 

C- 

IMPLICIT REAL»8< A-P.C-Z . J ) 

LOGICAL FG1 . FG2. FG3.-FG4. F is . INERF, RBLC. LEGU. LIMT(l) 

logical n start, ertape 

c .• 

c 

IMECER •. 



♦ AHOfiK 

. CTI . 

t 

CT2 


C T 3 


CT4 

» 

CT 5 


FCCN 

» 

PC ON 


* S CN CUM 

• SCN 

• 

SCRDUM 


SCR 


SFKDUM 

• 

SFK 


SF.R 

• 

SG 


♦ SI 

» Sib 

• 

S IXDU* 


six 


SKCUM 

• 

SK 


SL 

. 

SL K 


♦ SVA 

• SMCJUM 

• 

S*C 


SM V 


SCK 

• 

SP 1DUM 


SPI 

• 

SUF 


♦ S CL 

• S« 

t 

SSCN 


SS IX 


SVA 

. 

svo 


SVD 


SV l 


♦ SVM 

• SVP 

. 

S VQ 


sx* 


SXT 

• 

T CR U 


SMAL 

. 

SEU 


♦- SC 

• S CO 

* 

NFL X9 


SFLX 


SFXM 

• 

NMCOS 


SFCC 

» 

see 

r 

* I IN IT( 

1 ) 

. 

IZINI T< 1 ) 


SC 







• 

Co •. b C 

♦ 

v i 1 1 1 

e 

* P * » Y Ol 

X 



. 


* > . . 


. • 

. f 



RE AL * 6 

” 1 


' ' » . 




■ « 

r 

v *> r - 

7 

-■» » 

l 



♦ ANGC. 

( 33 ) 

» 

CNF 

( 

3.10) 

• 

ET 1C 

( 3 

.10) 

. 

ETMC 

< 3 

• 10) 


♦ FLU 

<2.20 ) 

. 

fle 

< 

2.3 ,20 ) 

t 

hLH 

( i 

.3 .20 ) 

* 





♦ ' ThACO 

( 23) 

* 

VMCO 

< 

3.2 . 1 1 ) 

• 

R INI T 

( 1 > 

. 

RZIN IT ( 1 ) 


c .. . , \ 

C - • , 

c 


C 0 50 0 0 00 
C05001 00 
C05CC200 
C0EC0300 
. C0500400 
C CS COSCO 
C050060C 
. CO 5 00 7 00 
C050C800 

cceoouoo 

CC501OCO 
CC501 Too 
C050120C 
C0501300 
CC5C1400 
C0501 500 
C05016C0 
CO 50 I 7 CO 
C050I800 
CO 5 0 1 900 
CC502000 
CO 502 1 CO 
C050220C 
C3S0230C 
C0502400 
C0502500 
CC E026C0 
CO 5027C0 
CO 502 800 
C05C29CO 
C C 50 3000 
C0503100 
CC503200 
C0503300 


A-30 


n r> 


, CCFMCN / CHEN S/ NSTART, LRTAPE C0503400 

C0503500 

, , C05C3600 


CONMCN 

/LOGIC/ 

FG l • FG2* FG3* FGS* 

INEKF. 

RQLQ( 10) 


C05C3700 


- 











C0503800 













CO 5 03900 

CO KMC F 

/ INTO/ 


A WORK 

(200 ) 







C0504C00 

♦ 

Ctl 



02 



CT3 


9 

CT4 

• 

C0S041 00 

♦ 

CT5 



FCON 

( 33 ) 


JCCN 

(10) 

9 

LCCN 

( 22 ) . 

CO 5042 CO 

■ * 

MC 

( 10 ) 


Nt»l . 



N3UD 


• 

NGTC 


C05043C0 

* 

NFER 



NFKC 

. . . . 


NFRC. 

K 

• 

NLUR 


C05044C0 

■* 

N * V 



N NO 



NMOA 


• 

N5VF , 


C0504500 

4 

NSVC 



FCON 

(11) 


SO . 



SFR 

( 33 ) . 

COE04600 

* 

SC 



S I 

( 55 ) 


SIG 


• 

St_ 

• 

C05047C0 

* 

SLK 

(33) 


SNA 

( 10) 


SC* 

(11) 

• 

SUF . : 

(11) . 

C0E048C0 


SCL 

( 11 ) 


svv 



SR • 


• 

SSCN 


C05C4900 

* 

3 S I > 



SVA 



SVB 


• 

SVC 

• 

C 0 £0 5000 

* 

sv I 



SV M 



SVP 

(22) 

• 

S V Q . 

(33) 

C0605100 

* 

S XM 

(3.10) 


SXT 



TOFU 

(s (7) 


SMAL 


C 0 5052 00 

* 

seu 



MU 



SC 

( 33 > 

• 

SCG 

• 

COE05300 

4 

NFL >3 



SFLX 



SFXM 

(10) 

• 

NMOOS 

• 

CO 505400 

* 

SFCC 



see 

(10) 







CO E055C0 













CO 505600 













CO 5057 00 

CC^CN 

/ IN To Z/ 










C0505800 

* 

SCNCbM 


• 

SCN 

( 9 > 

• 

SCRDOM 


• 

SCR 

(9) 

COE05900 

4 

SFKCuM 


• 

SFK 

(?) 

• 

S IXCUM 


• 

SIX 

(9) 

CCE0600C 

♦ 

S*CLN 


* 

SK 

( 9 ) 

t 

SPIOUM 


• 

SPl 

(9) , 

CO 506 100 

* 

SKCCV.M 


9 

SNC 

( 9 ) 







C05062 CO 













C0506300 













CO 506400 

CON'MC N 

/real/ 










CO E06500 

* 

c» 

(3.10) 

9 

CAC , 

(3,10) •• 


CLM 

(10) 


CCNC 

(3.11) , 

C 0 EO 66 00 

* 

OCMC 

(3.11) 

9 

ETC 

(3.11) 


ETM 

113) , 


• F C ML 

(3,11) 

C C 5067 CC 

♦ 

GAM 

(3.00) 

9 

F 



HM 

(3. 10) 


HMC 

(3.10) . 

C05068CC 

♦ 

HMC H 

(1C) 


PHI 

( 3 i 1 1 > 


PLM • 

110) 


OF 

(3.33) . 

C05C69C0 

* 

QFC 

(3.33) 

9 

CL 

(3.22) 


ULC 

(3,22) 


RCMC 

(3.11) , 

CC5C7000 

• * 

T 


9 




THA 

( 33) 


THAU 

(33) , 

CO 50 7 1 00 

* 

TFAC* 

( 10) 

9 

THAW 

( 10 ) 


XOIC 

( J»3 »fco) ♦ 

XI 

(3,3,10 , 

C0507200 

4 

X IC 

(3.3,10) 

9 

XNAS 

( 10 ) 


XMN 

(33.33) 

•' • 

XMT 

(3,3.10, 

C05C7300 

• * 

tlg 

( 33) 

9 

FLA 

(3,20 


FL6 

( 3,20 ) 

9 

FL C 

(3.20) . 

CCE07400 

♦ 

FLO 

(3,3.20) 

9 

FL J 

(3.3.20 ) 


CAC 

(3.10) 

9 

XIU 

(3.3,10), 

C0E07500 

* 

flirc 

(3,10) 

9 

flcrc 

(3.10 


Fi_ AC 

( 3,20 ) 

9 

FLOC 

(3.20) 

CO 50 7600 

* 

flc* 

(20) 

9 

Zt TA 

( 20 ) 


FCF 

( 3,3 .40) . 

FCK 

(3.40) , 

C05077CO 

* 

T 1 M E NO 



i 






i •' 


C0507800 













CC5C7900 













CO 5C8000 


CCKMCN 

/REAL z/ 


i 



, 





C0E081 00 


ceoLM 

(1.3) 

9 

ce 

(3,10) 

1 

CriCDJMt 1,3) 

9 

CBC •• 

(3.10 . 

C 0 50 82 0 0 

• * 

XKCCL-U 1.1.9) 

9 ■ 

XMC 

(3.3.10) 

• 

CoN ( 3) 





C 0 508300 



. 1 •( 


f 

A. .*.*•«'* i. 



• r 


> , 


C0508400 


' 








* ■ 

' 


C 0508500 


EQL I VALENCE ( ETM( 1 ) . THACC ( 1 ) > 


• 

( XMN ( 1 . 

1 ) 

, ANGD ( 1 ) > , 

C C 5C 8600 

' * 


( XMN 

1.3), 

YNCCX 1.1, 

1 ) ) , 

( XMN ( 1 . 


, CNF ( 1. 

1 ) ) 

C0508700 

*4 

V . ‘ 

( XMN ( 1 .6) . 

ETIC( 1 .1 )> 

• 

( XMN ( 1 . 

10) . b TM C ( 

1 . 1 > ) . 

CO 508800 

♦ 


( FL0 ( 

1.1). 

FLC( 1 . 1) ) 


* 

ifle ( l , 

1 • 

T) ,FLD( 

1 . 1 . 1 ) > . 

C05089CO 

* 


(F LH( 1.1.1 

) ,FL J( 1 . 1 

• 

1 ) ) , 

■ 




CC5090C0 

’ * 


( F G 1 

L INI T( 1 ) ) 


* 

(CA(l.l). 

R INIT ( 1 ) > . 

C 0 5 091 00 

* 


(C0OGM (1,1 

) ,RZ IN IT ( 1 ) ) 

( AWORM 1 ) 

, UNIT! 1 )) . 

C0509200 

4 


( SCNDLF .UIMTIIII 







CC5C93C0 


A-31 


c 

c 

c 

c 

c 

c 


CIVENSICN 00(2) 


N = 1 
L = 1 

cycle 

CO 1 
CHECK 


THRU OATA 
K = 1 .NO CD 
TO SEE IF 


F OH ALL ECO IE S 


IE POSITIVE 


BODY VASE 
IF(XVAS(K).gT.O) gc TO 1C 
PRINT 2CC. K.XVAS(K) 

FG2 - .FALSE. 

C CHECK TO SEE IF TCFOLOGICAL TREE PROPERLY LABELED 

1C IF(JCGNtK).LT.K) GO TO 11 
PRINT 20. JCCMK1.K 
FG 2 = .FALSE. 

C CHECK NLVdER OF CONSTRAINED AXES. AT MOST 3 

11 IF (PCQn (K ) .GE . C. ANC.PCCN (K ) ,LE . J ) GC TO 12 

K 1 = K-l / 

PRINT 2C2. K.PCONIKI.Kl 
FG 2 = .FALSE. 

12 IF< .KCT.POLG(K) ) GC TO 12 

CO 2 1=1,3 

CO 2 J= 1 • 3 

C CHECK SYVMETRY OF INERTIA TENSOR 

IF (X I ( I . J.K) .EC. X I( J, I ,K ) ) GC TO 2 
PRINT 2C2. K 
FG2 = .FALSE. 

2 CONTINUE 

C DETERMINANT OF INERTIA TENSCP MOST eE POSITIVE FOR IT 

C TO HAVE REAL PRINCIPAL VCVENTS OF INERTIA 

CET = XIU.1.K)*I*I(2,2,K)»XI(J.3,K) - XU2. 3. K)*X1(3. 2. K)) 

* -X I ( 1 .2 .K ) *( XI (2 , 1 ,K> »X I( 3. J.K.) - XI (3. I .N >*XI (2 .3.K) ) 

* + X I ( l .3 .K ) *( X 1(2 , 1 , K )*XI ( J.2.K 1 - XI (2 . 2. K. )«XI ( 3 , 1 ,K ) ) 
IF(OET.GT.O) GC TO 13 
PR INT 204. N.DET 

FG2 = .FALSc. , 

C CHECK CRT HOG CN AL I T Y OF T R AN SFURMAT I CN MATRIX 

1 2 CO 3 1=1.3 

CO 3 J= 1 1 3 
TEST = C 
CO A L*lt3 

A TEST = TEST «• XM T (L . I . K ) * X V T ( L . J . K ) 

IF ( ( .EC .3) GC TO 14 
IF(D Acs ( TEST ) .LT .,. 10-021 GC TO J 
PRINT 2CS, I.J.TEST.K 
FG 2 = .FALSE. 

••GO TC 3 ........ . ... 

1 4 IF (C ABS( OAQS( TEST )-l .DC) .LT . . 13-03 ) GO TO 3 

PRINT 2CS. l.J, TEST.K ... .... , . ' 

NO Tf.03vF.G2 ,= .FALSE. jTDv', . 

3 CONT INUE 

1 CONTINUE 

200 FORMAT (lOX.'MASS CF BCDY’.IS.' =>.DlS.Si< 2ERO Ok NEGATIVE MASS 

* LEVGnts LN AC CE p Tm 6LE ’,/) 

.201 FORMAT < IOX, • JC0MK1 MLS T BE LESS THAN K BODY*. 13. 

**EEN BODY 1ANC dCCY'.ia, 1 IN TOPOLOGICAL TREE'./) 




)' i 


• CANNOT LIE 


C05C94CO 
CO 509500 
CC5C9600 
C 0 50 97 00 
CC509800 
C 05C9900 
COS 1 0000 
CCSIOIOO 
CO 51 0200 
C051 0300 
C051 0400 
CC51 05CO 
C 0 5 I 0600 
COE 10700 
CO 5 1 0800 
C051 09C0 
C C 51 1000 
C051 1 1 CO 
CO 5 1 1200 
C 0 5 1 I JCO 
CO 5 l 1400 
C 0 5 1 I 500 
C C 51 1 6CO 
C 0 51 1 700 

c o 5 1 iaoo 

C 0 51 1 9C0 
' C051 2000 
C0S1 2 1 00 
C05T2200 
C051 2300 
C0E1 2400 
C051 2500 
CC5I 2600 
CC51 2700 
C0E1 2800 
C C 51 29 TO 
C 05 1 3000 
C051 3100 
COS 1 3200 
C0S1 3 3 C 0 
COSI3400 
C0S1 3500 
C051 3600 
C051 3700 
C 0 51 3800 
CO 51 3900 
C 0 5 1 4C00 
C051 4 1 CO 
CC51 4200 
COE 1 43C0 
C051 44CG 
C051 4500 
0051 46C0 
,0051 47 CO 
CC51 4800 
C051 4900 
E C0E1 5000 
C0515I00 
eET C 0 5 1 5 2C0 
CO 5 1 5300 


A-32 


r> n n n r> n n on nn no 


202 FORMAT C ICX. 'BODY • .13. • CANNOT HAVE*. 13,* CONSTRAINED AXES AT HINGCCE15400 

* E PC INT • . I 3. ✓ ) C 0 El 5500 

203 FORMAT ( 10X . • I NER T 1 A TEN SCR CF OODY'.I3.' NCN-5 YMKET R l C •> COE15600 

2C4 FORMAT ( 10 X . 'DE TE RM I N A N T CF THE INERTIA TENSOR OF BODY*. 13,* = • . 0 1 C C E l 5700 

♦£.£•■ IT MUST BE POSITIVE FCR REAL FRInCIPAL MOMENTS OF INERTIA *.COS15800 
*/) CO 51 5900 

20E FORMAT 1 10X. 'EIGENVECTOR • .12.* DOT • , I 3 . • = • . C I 5 . 5 . • FOR TFE TRAN SF C C E 1 60 CO 
4CRNATICN MATRIX OF eODY*,I3./) CCE161C0 

RETURN C0516200 

ENC C0E163C0 


SUERCuTlNE SETS 


IMPLICIT REAL*e<A-h, 0-2.1 1 

LOGICAL FG1 . FG2. FG3. FG4, FG5. INERF, R8LC. LEQU. LINITIll 
LOGICAL NSTART. LR T APE 


INTEGER Eli 10) ,S2( 10) .E2NNM1 
INTEGER 


C0600000 

coeooioo 
C0600200 
C0600300 
00600400 
C 06 00500 
C060C600 
C060C700 
C0600800 
C06C0900 
C0601 000 



AkORK 

. CTl , 

C T 2 

. CT2 . 

CT4 

, CT5 

• 

FCON 


PCCN 

• 

CO 60 1 100 


SCNCUM 

. SCN . 

SCRQUM 

• SCR . 

sfndum 

, SPK 

• 

SFR 


SG 

# 

CO 60 1 200 


S I 

. SIG . 

SIXDUM 

.six . 

SKDUM 

, SK 

• 

SL 


SLK 

• 

CO 60 1 300 


SMA S' 

. SMCOUM. 

SMC 

. SMV . 

SOK 

, SPIDUM 

$ 

SPI 


SQF 

• 

CO 60 1 400 


SCL 

• SR . 

SSCN 

. SS IX . 

SVM 

. sve 

• 

SVD 


svi 

• 

CO 6 0 1 500 


SVM 

. SVP 

SVQ 

. SXM . 

SXT 

, TORU 

• 

SMAL 


SEU 

• 

C 0 60 l 600 


SC 

. SCG . 

NFLX8 

. SFLX . 

SFXM 

, NMODS 

* 

SFCC 


see 


C06C1 700 


I INITI 1 ) . 

UINIT(I) . 

SO 







C060 180 C 













CO 60 1 90 0 
C0602000 


pe al 











C0602100 

* 

AN G C 

(33) • 

CNF 

(2.10 . 

ETIC 

(3,101 

• 

ETMC 

13.101 

t 

C0602200 

* 

FLO 

(3*20) 

FLE 

< 2,3.20) . 

FLH 

(3.3.201 

• 





C0602300 

* 

T HA CD 

( 3J) 

YMCD 

(2.2,111, 

flIMT 

( 1 1 

• 

R21NITI 1 1 


C0602400 













C060250C 

C060260C 

C0602700 


CGKMCN 

✓ CHtZKS/ 


NSTART, 

LRTAPt 







C0602800 

CC6C2900 

C0603000 


CC NMCN 

/LOGIC/ F 

Gl. FG 2 

. FG3. FG4, FG5, 

INERF, 

RQLJ( 101 




C06031 00 













CO 603200 
CO 603300 


Cb^MCN 

/ INTO/ 

AkORK 

(200 1 , 








CO 60 340 0 


CT 1 

• 

CT2 

• 

CT3 



CT A 



• 

CO 60 3500 


C T 5 

t 

FCCN 

<221 . 

JCCN 

I I0> 


L CON 

(221 

• 

CO 603600 


MC 

(1C) • 

NE1 

• 

NbUD 



NCTC 


Jft -t 4 

-• 

-.-C0603700 


NFER 

• 

NFKC 

• 

NFRC 



NLOR 



• 

CO 603800 


N* V 

• 

NMC 

• 

NMG A 



NS VP 



* 

C060390C 


N S VC 

• 

FCON 

(111 . 

SO 



SFR 

(33 1 

• 

C 0 6 0400 0 


SC- 

• 

S I 

( E5) . 

SIG 



SL 



• 

CO 604 100 


SLK 

(33) 

SMA 

(101 . 

SuK 

(111 


SQF 

(111 

• 

C0604200 


SCL 

(11) . 

SMV 

» 

SR 



SSCN 



• 

C0604300 


5 £ I X 

• 

SVA 

• 

SVB 



SVO 



« 

CO 6 04 400 
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u u , . O W ' . ‘ U U O u 


c 

c 

c 

c 

c 

c 

c 

'C 

c 

c 

,c~ 

c 


-* 

SVI 


» 

5 V M 


• 

SVP 

(22) 

SVQ 

(33) , 

C0604500 

* 

SXM 

(3.10) 

t 

£ XT 


• 

TORO 

(97) 

SMAL 

• , 

CO 604 60 0 

* 

seu 


* 

Mfl 


• 

SC 

(33) 

SCG 

♦ 

C06C4700 

* 

NFLX3 


0 

SFLX 


• 

SF XM 

(10) 

NMODS 

0 

C06C4800 

* 

SFCC 


• 

see 

( 10) 






CO 604900 

cceoEooc 

C0605100 


CC WMCN 

/ 1NTG Z/ 









C060520C 

.* 

SCNCLM 


• 

SC N 

( 9 ) 

0 

SCRDUM 


SCR. 

(?) , 

' C060530C 

:* 

SFKCUM 


• 

SFK 

( 9 ) 

0 

S I XDUM 

. 

six 

(9) 

CO 60540 0 

* 

SKDLM 


0 

£K 

(9). 

• 

SPIDUM 

,, SPI 

( 9 ) . 

C C 60550 0 

* 

S^CCUM 


• 

SMC 

(5) 






CO 60560 0 
C0605700 
CC 6 05 80 0 

CONMC-fs 

/REAL/ 









C0605900 

•.* 

C A 

(3.10) 


C AC 

(3.10) 


CL M 

(10) 

CC MC 

(3.11) . 

coeoeooo 

* 

DC M C 

(3.11) 


ETC 

(3.11) 


ETM 

( 33) 

FCMC 

(3.11) . 

CC606100 

>1 

GAM 

( 3 , 66 ) 


b 



HM 

(3.10) 

HMC 

(3.10) , 

C0606200 

* 

HMC b 

< 10 ) 


Fh I 

(3.11) 


PL M 

( 10 ) 

QF 

( 3 , J 3 ) , 

C060630C 


OF C 

(3.33) 


QL 

(3.22) 


ULC 

( 3.22 ) 

R G MC 

(3.11) , 

C 0 60 640 0 

■* 

T 






THA 

(33) 

THAD 

(33) ’ 

C 0 60650 0 

* 

T HA C *> 

( 10 ) 


TbAW 

( 10) 


XDIC 

(3.3.66) 

XI 

(3.3.10 , 

C0606600 

* 

X IC 

( 3.3, 10) 


>M A S 

(1C) 


XMN 

( 33 . 33) 

XM T 

(3.3.10, 

CC6.0670C 

* 

T LG 

( 33) 


FLA 

(3.20 


FLB 

( 3 .20 ) 

FLC 

(3.20) . 

cceofc 800 

* 

FLD 

(3,3.20) 


FL J 

(3.3.20) 


CAD 

(3.10) 

X IQ 

(3.3.10 . 

CC606900 

* 

FL IRC 

(3.10) 


FLCRC 

(3. 1CI 


FLAG 

(3.20) 

FLQC 

(3.20) 

C C607CCC 

* 

FLC N 

(20) 


ZfcTA 

(20) 


FCF 

( 3,3 .40) 

FCK 

(3.40) . 

C0tC7 100 

* 

T IMEND 










C0607200 
C 0 60 7 30 0 
,00607400 

ccvmcn 

/REAL Z/ 









C060750C 

* 

CEDLM 

(1.3) 

• 

CC 

(3.10) 

• 

C*3CDUM (1,3) . 

CQC 

(3.10)' . 

CO 6 07600 

* 

X RC C L M ( 1,1.9) 

• 

XMC 

(3.3.10) 

• 

CBN( 3) 




C0607700 


EQLIVALENCE <ETM( J > . THACC1 l > ) 

* ( XMN( 1 .3 > . YMCD( l .1 . 1 ) ) 

* . ( XMN ( 1 .8 > .ET IC ( 1 . I ) > . 

* IFLBl 1,1) , FLC ( 1 . 1 ) ) 

* ( F LH ( 1,1.1) • FL J ( 1 .1.1)) 

.* , (F61 ,LINIT(1 )) 

* <CBOUM( l . 1 ) .RZ IMT< 1 ) ) 

* < SCNDLF , IZ IMT ( 1 ) ) 


. ( XMN ( 1.1). ANGD( 1 ) ) , 

, ( XMN 1 1,6), CNF ( 1,1)) . 

. ( XMN < 1 .10) . ETMC( 1.1)) , 

. (FLE (1.1.1), FLO ( 1,1,1)), 

, 

, (CA( 1 .1 ) ,R INIT( 1 ) ) , 

. (A«OKM l ) . 1IMTI 1 ) ) , 


OET THE EE T 3 Sfi AND SL 

, SR = SET OF eouv LABELS OF RIGID BODIES (CCMPACTED) 

EL = SET OF BOD Y LABELS CF LINEAR OSCILLATORS (COMPACTED) 

EG = SET OF dODY LABELS CF GYROSTATS ( CCMF ACTED ) 




-■> j . 


c i- 


NR = 0 
NL = 0 

CO 1 l=l.NdOD 
IF(RELO(I)) GO TO 14 
NL = NL « 1 


C0E0780C 
C C 607900 
C060800C 

coeoeioo 

C06C820C 
CO 60 830 0 

co tCBAOO 

C C 608500 
CC6C860C 
C06C870C 

ccecasoo 
C06C8900 
CC609000 
C0609100 
C0609200 
C0609300 
CO 609400 
C 0 60 9500 
CC60960C 
CC609700 
C060980C 
' 1 CC6C99C0 
COtl 0000 
C0610100 
COtl 0200 

ccei 0300 

COtl 0400 


A-34 


non n. n 


S2INL) = I 
GO TC 1 

1 4 NR = NR * 1 , 

SI (NS ) = I ' 

1 CONTINUE 

C COKPACT Si (NR) INTO SR ANO ^ 

C S21NL) INTO SL 

CALU CLKFACI SI ,NR .SR) 

CALL CUNFACIS2.NL.SL) 

GET SET SG GF GYROSTAT E COY LABELS 

IF(NNG.EC.O) GO TC 1? *• ■ !' 

CO I t I = l • 1 0 

. S 1 ( I ) = c 
1 f S2 < I ) = C 

CC IT K='l.NMC 

L = KC I K ) *' 

17 SUL) = I 
K = C 

CO IE 1=1.10 
IF(Slin.Eu.O) GO TC ie 

K = K«‘l • > : 

S 2 ( K ) = I ’ * ' . 

1 8 CONT INue 

CALL CCNFACI S2 .K , SG) • . 

GO TC I E 

IS SG = C ’ . 

GO TC IS 

CET THE SETS OF 90DIES GLT8CARD OF HINGE POINT K 

COMPACTED FORKS IN SK1K) ' t 

IE NM 1 s NECD - 1 »• 

CO 2 L = 1 .NBUD 
K = L-l 

co a i=i,NabD 

4 S 1 ( I ) = C * • i • ■ 

NC » 0 , - ' • - 

C CYCLE THRU BUD I ES l*HICH CAN BE OUTBOARD OF K ’ J '■ 

ITEST = K» l 

CO 3 J= I TEST.NdOO ' 

IN = J ' , ‘ 

E IF(IN-l-N) 6.7.8 
G EG C Y J NOT ON PATH FRCK K 

E CO TC 3 

C EOCY J CLTBUARD OF HINGE K CN CHAIN FROM K. 

? NC = NC + I 
S 1 ( N C ) = J 
CO TC J 

C EOCY J CAN be ON CHAIN FRCK! K 

E IN s JC C N ( IN ) 

^ .. GO TC 5 _ 1 * • 5 . ■'**.* > ■/ (j 7 j v ” >* 

2 CONTINUE ‘ 

C. CCWPACT SET SK(K) ■' ' 

r ,„ .CALL COKFACI SI .NC .SK< K ) ) 

2 CONTINUE 

C CET SETS OF BODIES ON PATH FROM HINGE POINT I 

C TO C.K. OF UCCY Nfi; SKKTCINBOD. I.N) 

C K T C = FUNCTION TO PUT TRIANGULAR ARRAYS IN CNE D I MENS 10 NAL ARFAY 

CO 9 L= I .NdOD 
I = L-l 


COEIOSOC 
CO tl 060 0 

,CCE1 0700 
CC610800 

• COE 1 0900 
CC E 1 I 000 
COfcl 1 100 
COEl 1 200 
C061 1 300 
COEl 1 400 
COE I 1 500 
COEl 1 60 C 
COEl 1 700 
COEl 1 80C 
COEl 1900 
CCE12000 
C0E1210C 
C0E12200 

■ C 0 6 1 2 300 
C0E1240O 
C 0 E 1 2 50 0 
COEl 2600 
■ 'COEl 2700 
COEl 2800 
COEl 2900 
C CE 1 3000 
C0613100 
COE I 3200 
COE 1 3300 
COEl 3400 
C0E135OC 
COE 1 3600 

' C0E13700 
COEl 3800 
COE1390C 
C0E14000 

cceiAioc 

COEl 4200 
COEl 4300 
C0E1440C 
C061450C 
COEl 4600 
CC614700 
COE 1 4800 
C CE 1 4900 

. CCE1500C 
C0E15100 
CCE1 52C0 
COEl 5300 
COEl 5400 
“ C 0 6 1 5 500 
COEl 560 0 
C0E15700 
COEl 5800 
COEl 5900 
C CE 1 6000 

• C0616100 
CC £ 1 6200 

'COEl 6300 
C0E1E4OO 
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CALL UHPAC( 32. NSE T ,SK( I ) ) 

CO 1C N=I.NM1 
1C S I IK TOI NSOD. 1 .N) > = C 
CO 11 NN=1 i NSET 
CO 1 ;■ K = 1 .NBOO 

1 2 S 1 < K ) = C 

NC = C 

IN = S2(N N) 

12 IF ( I N-l .LT . J ) GO TC 20 
NC = N'C * 1 ' 

SI (NC) = IN 
IN = JCCN( IN ) 

GO TC -12 

2 C CONTINUE 

c 

CALL CCMPAC ( SI .NC .SI (KTOINBCO . I ,S2(NNI-1 ) ) ) 
11 CONTINUE 
5 CCNTINLE 

c 

C COMPETE REQUIRED SUMMATICN SETS 

I'M = l 
LL = 1 

CO 22 K=1.N01 

IF(K.EU.l) GC TO 23 
(KM = MM*3-PCCN IK- 1 ) 

LL = LL+FCCNIK— l 1 
- 22 IF(PCUN(K).N£.3) GC TO 24 

- SQFIK 1 = C 
SQL( K 1 = LL 

GO TC J 22 

24 IF (PCCN (K) .NE. 0) GC TO 2E 
SQFIK ) = MM 
SQL IK) = 0 
GO TC 22 
2 E SQFIK) = MM 
■ SQL I K ) = LL 
22 CONT INUE 
RETURN 
ENC 


CC61 6500 
C0616600 
C 0 61 6700 
CC616800 
CC616900 
00617000 
CO 6 17 100 
C C 61 7200 
C 0 61 7300 
C061 7400 
C061 7500 

ccei 7600 

0061 7700 
C061 7800 
CC61 7900 

ccei aooc 

C061 8100 
C 061 8200 
CO 61 8 30 0 
CC618400 
C061 8500 
COtl 8600 
C 0 61 8700 
C061 8800 
C061 8900 
CC61 9000 
C061 9100 
CO 61 9200 
C 06 1 9 30 0 
C0619400 
C061950C 
C061 9600 
C061 970C 
CC61 98CC 
C061 9900 
CC620000 
CO 620 100 
C062C200 
C C 62 0300 


C 

c 

c 

" c 
c 
c 

c 

c 

c 

c 

c 

c 

c 


SUERCUT INc I NOPT 

ACCEPTS all INFORMATION-NEEDED TO DEFINE THE CUMPUT A T l CN AL 
OPTIONS WHICH CAN BE EXECUTED BT THE USER 
THE FulLC.NING AUGMENTED SET DEFINITIONS ARE MADE 


ALL eCD IE S ’CUTECASC UF - HINGE tP-GI'NT 1AGE:B0CY I + l 
ALL ECD I E S CF NEST I CONTRIBUTING SIGNIFICANTLY 
TU PSLEDQ "INERTIA TENSCRS CF NEST I 
SIXII) = ALL ECDIES CF NEST= IUCCNTRIBUT ING JSIGNIE ICANTLY 

^ TO I NE R f A "C RCS S COUPLING cFF EC TS' 'IN .'NEST I MOTION 
EQUATION, 

SCNII) = ALL ECDIES CF NEST I CONTRIBUTING SIGNIFICANTLY 

TO C ENTR I P 1 T AL CROSS COUPLING EFFECTS IN NEST I . 
MOTION EQLATICN 

SCRII) = ALL ECDIES CF NEST I CONTRIBUTING SIGNIFICANTLY 
EUUA T IGN 


•NEST I* 
SPI I I 1 


CC 700000 
C070010C 
CO 700200 
C07C0300 
CC 700400 
CO 700500 
CO 700600 
CO 700700 
CC 700800 
CC70090C 
CC701 000 
CO 701 l 00 
C 0 70 I 200 
CO 701 300 
CC7C1400 
C0701500 
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nrvr»rvrvnr>nnonnonnnrvr>n n r» r> n r* nnnnnnnnnonnnnnnn no n n o <">• n n n r> n 


TC CORIOLIS CROSS COUPLING EFFECTS IN NEST I MOTION 
S ML ( I ) = ALL CONSTANT AND VAR I ABLE. SPEED MOMENTUM top EEL S 

I N NEST I 

SC = ALL CCNTIGLCLS PAIRS OF BODIES (JCCN(K).K) FOR WPICF 
DIRECTION COSINE TECHNIQUES ARE. TO 8E USED TC CCMPLTE 
RELATIVE TR AN £ FOR MAT 1 C N MATRICES 

SD SFOULO CONTAIN ONLY LABELS FOR RIGIC OP FLEXIELE 
BODIES 

SMAL = ALL CCNTIGLCLS PAIRS OF BODIES (JCCNK).K) F OF WHICP 
SMALL ANGLE TECFNIOOES ARE TO eE USED TO COMPUTE, 
RELATIVE TRANSFORMATION MATRICES . , , 

SEU = ALL CCNTIGLCLS PAIRS OF JODIES (JCUNIK).K) FOR WPICH 
EULER ANGLE TECHNIQUES ARE TO EE USED TO COMPUTE 
RELATIVE TR ANSFCRMAT1 CN MATRICES 
SXM(I.K) = COMPLTEO CODE WORD ARRAY 

THE CCOROINATE AXIS I N BODY K ALONG WHICH THE I-TH 
FREE CR LOCKED GIMBAL AXIS IS ALIGNED, SIGN IMPLIES 
DIRECTION 

' NOTE 1 INTERNAL LOGIC ASSUMES THAT THE FREE 
COORDINATE VECTORS AT H INGE POINTS' AT WHICH SMALL- 
ANGLE OR ELLER ANGLE TECHNIQUES ARE APPLIED ARE , 
PARALLEL TO THE BODY FIXEC AXES DEFINED 
AT THAT PCINT 

EXT = ALL COLUMNS CF THE SYSTEM INERTIA MATRIX OF PSUECO- 
INERTIA TENSORS WHICH HAVE TIME VARYING ELEMENTS. 
(SINCE INERTIA MATRIX SYMMETRIC COLUMNS DESIGNATED 
EXTEND DOWN ONLY TO D I AGON AL ELEME NT , C OLUMN N+ l IS 
ALWAYS ASSUMED t I ME VARYING! 

ELEMENTS IN COLUMN K,K=1,2 GIVE THE INERTIA 

CONTRIBUTIONS CF THE NEST K-l TU THE SYSTEM EOLATIONS 
OF MOTION 

SMV = ALL VARIABLE SPEED MOMENTUM WHEELS j 

SVD = ALL ECDIES IN WHICH BODY FIXED VECTORS AND DYADS ARE 
TIME VARYING IN THE CCMFUTATIONAl REFERENCE FRAME 
SFH(I) = SET CP FREE COORDINATE VECTOR LABELS CF THOSE VICTORS 
ABOUT OR ALONG WHICH DISPLACEMENT IS COMPUTED , 
SLMI) = SET CP LOCKEC CCOROINATE VECTOR LABELS OF THOSE VECTO 
ABOUT OP ALCNC WHICH CONSTRAINT TORUUE IS COMPUTED 
THIS CAPABILITY NJT AVAILABLE IN N-BGD2 
SM'A(I) = set CF MG ME N I UM WHEEL LABELS CF THOSE WHEELS FOR 
WHICH ANGLLAR DISPLACEMENT IS TU BE COMPUTED 


INSRF = 


SC ( I ) 

see 

T U G { J ) 


. TRUE . 
.FALSE. 


CCMFUTATIUN FRAME IS INERTIAL REFERENCE 
COMPUTATION FRAME FIXED IN BODY 1 


all cageo oegrees of freedom 

TOTAL NUMBER CF CAGED DEGREES CF FREEDOM 
TIME AT WHICH C EGREE OF FREEDOM J UNCAGED 


' I 


NFLXB . = JTC-T*AL NUMBE.fi ^GF, .FLEX l BLE BODIES ■> r ->- <? 

SFLX = SET CF ALL FLEXIBLE BODIES .• • 

SFX.M(I) = TOTAL NUMEEfi GF FLEXIBLE BODY, MODES USED FOR eOD 
*. ■ UERCcI Fmf.BOCXi X 2 : j i G J 3 JJA = (i)Xi 

NMLXS = TOT AL^NUMBER^GF Fi_EXIELE BQOY-MUDES USED FOR ENT 
SI *ULAT I CN # 


V I 

D 

IR E 


C 

C 

C 

c 


resultant fl 

FLA(I.MN) = 
FLBII.MM = 


EXIBLE BODY MODAL PARAMETERS . 

MODE MN CENTER- OF MASS 

MASS MODAL MOMENT ABOUT HINGE PCINT FGP 


CO 70160C 
C07C17C0 
C0701800 
C07C1900 
CO 70 2 0 OC 
C07021 00 
C C 702200 
CC 702300 
C07C2400 
CO 702500 
CO 702600 
C C 7027 00 
CC 702000 
C C 7 02900 
CC7C3000 
C0703100 
CO 703200 
CO 703300 
CO 70 3 A 0 0 
CO 703500 
CO 703600 
C07C3700 
CC 703000 
CC7C3900 
CO 704000 
CC704100 
C C7C4200 
CC 7C4300 
CC704400 
CO 704500 
CO 7046C0 
CC 7C470C 
CC 704000 
CC 7C4900 
CC 705000 
CO 705 1 00 
CO 705200 
CC 705300 
CO 705400 
CO 705500 
CO 705600 
CO 705700 
CO7C50OO 
CC7C5900 
CC 706 00 0 
CC 706100 
CO 736200 
CO 7C6300 
CO 706400 
C 0 7 06500 
CO 70660C 
CO 7C67C0 
CC 706000 
CO 7069^00 
CC7C7000 
CO 7C71 00 
CO 7C7200 
C0707300 
CO 7C7400 
C 0 7 C 7 500 
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n o 


FLC ( I. MN) = 

FLO ( I i J, KM = 
FLJ < I .4. KM = 


MODE MN DUE TC TRANSLATION OF MASS POINTS 

inertia ^mccal moment for Moot mn due to 

ROTATION CF MASS POINTS 
P SUE DC— INERTIA COUPLING TENSOR FOR MODE MN 
CENTRIPITAL COUPLING TENSOR FCfi MODE MN 


FOR MODE M OF ECCY N , MODAL NUMdER MN IS 
MN SFXM( I )♦. .. *£FXM(N-l )*M 

FGR ELASTIC COOFCINATE MN 

THAINFER+MN) = INITIAL GENERALIZED - DISPLACEMENT, ELASTIC COORD. MN 
rpAC< NFER kmN) = INITIAL GENERALIZED RATE. ELASTIC CCORD. MN 
NFER = TOTAL NUMBER CF FREE COORDINATE VECTORS 

SFCC = SET CF ALL FLEXIBLE BODIES FOR WHICH CENTRIPETAL AND 
CORIOLIS EFFECTS SIGNIFICANT IN’ DEFORMAT ION EQUATION 
• SC X C ( MN ) = SET CF ALL KCCES N WHICH SIGNIFICANTLY CONTRIBUTE 

TO TFE CENTRIPETAL OR CORIOLIS CRUSS COUPLING EFFECT 
IN TFE EQLATICN FUR MODE WITH MODE NUMBER MN 

RESULTANT MODE COUPLING COEFFICIENTS FOR MODE M AND N 
FCFIM.NJ = MODE CROSS COUPLING TENSUR CENTRIPETAL ACC. EFFECTS 
I IN MOST CASES FCFIM.NI J K = NCAN HAVE SIGNIFICANT 
NCN-2ERO TEFMS) 

FCFIM.NI ■= MODE CROSS COUPLING VECTOR FCR CORIOLIS ACC. EFFECTS 


IMPLICIT REALWEI A-F.C-Z.S) 
LOGICAL' FG1 . FG2. FG3 . FG4 , FSS. 

LOGICAL NSTART. LRTAPE 

3 


INERF. RBLC. LEQU. LINIT(l) 


CC 7 C 7 6 0 0 
CO 7C7700 
CO 707800 
C07C7900 
C 0 706000 
CO 706100 
CO 708200 
CO 706300 
CO 708400 
CO 708500 
CC 7C8600 
CO 708700 
CO 708800 
CO 7C8900 
C C 709000 
CO 7091 OC 
CO 709200 
SCO 709300 
CC 709400 
CO 709500 
CC 7C96C0 
CO 709700 
CO 709800 
CC7C9900 
. CO 71 0000 
CO 71 0100 
C C 71 0200 
C.071 0300 
C O 7 I 0 40 0 
■CC 71 0500 
CO 71 060 0 
CO 71 0700 
CO 71 0800 
CC71 0900 



A«CFK 

. CTl 


CT2 . CT3 


CT4 


CT5 

FCON 

• 

FCCN 

9 

■CO 71 1000 


SCNCUM 

. SCN 


SCROUM . SCR 


SFKOUM 


SFK . 

SFR 

• 

SG 

♦ 

CO 711100 


S I 

. S IG 


SIXOUM, SIX 


SK.OUM 


SK . 

SL 

• 

SLK 

9 

CO 71 1200 


SKA 

. SMC HUM 


SMC . SMV 


S OK 


SPIDUM. 

SPI 

9 

SQF 


CC 71 1300 


SCL 

. SR 


SSCN , SSIX 


SVA 


SVB . 

SVC 

9 

SV I 

9 

C C 7 1 1400 


SVM 

. svp 


SVQ . S X K 


SXT 


TORO 

SMAL 

9 

SEU 

9 

CO 71 l SOO 


SC 

. SCG 


NFL XB , SFLX 


SFXM 


NMCDS . 

SFCC 

9 

see 

9 

C 0 7 l 1600 


I IN IT( 

l ) 


I Z I N l T ( 1) 


SO 


SCXCI 20 ) 





CO 7 l 1700 














C 0 7 1 1800 














CC 71 1900 


REAL46 












CC 71 2000 

♦ 

ANGC 

( 33) 

* 

CNF (3.10 

» 

tiTIC 

< j 

.10) . 

ET MC 

( 3 

.10) 

9 

CO 71 2 100 


FLQ 

( 3.20 ) 

• 

FLE (3.3.20) 

9 

FL.H 

( j 

i 3 • *L 0 ) • 





C07I 2200 

* 

T MACD 

(33) 

• 

YMCD (3.2.11 ) 

• 

« I NI T 

( i > 

KZ IN IT ( I ) 


C C 7 1 2 30 0 









- * 





CO 71 2400 





. . - . ■ i ■ , ‘ . 




./ 





CO 7 12500 


COMMCN 

/CHEKS/ 


NSTART 

9 

lhtape 







CO 71 2600, 


'OCKMCN /LOGIC/ FGl. FG2. FG3. FG4 . FG5. INERF. ReLO(lO) 

• ft i J w .' I ^7 •*. 


COMMCN / INTG/ AWORK (200) . 

* C T 1 . C T 2 , CT3 . CT4 

* C T 5 . FCON (33) . JCCN (10) . LCON (22 1 

* MC (10) . N6 1 . NdOD • . NCTC 


CC 71 2700 
CO 71 2800 
CO 71 290 0 
.Cd71 3000 
CO 71 3 100 
C071 3200 
CO 71 33C0 
CO 71 3400 
C071 3500 



u o 


4' NFER 



NFKC 



N F R jC 


NLCR 


• 

CO 71 3600 

4 NNV 



NMQ 



NMOA 


NS VP 



CO 71 3700 

* N £ V G 



PC ON 

(in 


SO 


SFF 

(33) 

• 

CO 7 1 3800 

* SC 



£ I 

( ££> 


S IG 


SL 



CO 71 3900 

4 . S LK 

( 33) 


SNA 

(10) 


SCK 

oil.. 

SQF 

(11) 

• 

CC 71 4000 

• ■ - 4. SCL 

( 11 ) 


£V V 



SR 

• 

SSCN 


• 

CO 714 1 00 

: ♦ s s i x 



£ V A 



sva 


SVD 


• 

CO 71 4200 

* . S V I 



SVM 



S VP 

(22 ) . 

SVO ' 

(33) 

• 

CO 71 4300 

*' SXM 

(3.10) 


S X T 



TOP Q 

(0?) . 

SMAL 


t 

CC 71 4400 

• * SEU 



NT Q 



sc . 

(33) 

SCG 


• 

CC714S0C 

* NFL >B 



SFLX 



SFXM 

(10). , 

NMODS 

. 


CC71460C 

v * SFCC 



see 

(10) 







C'C 71 4 700 





■ . • 



, 


* fl 


CO 714 800 












C071 4900 

CGNMCN 

✓ INTO Z/ • 



. 







CO 7 1 5000 

'» SCNCLM 


• 

✓SCN 

( R ) 

•» 

SCRDJM i 

SCR 

(9) 

• 

CC 71 5 1 00 

♦ SFKCL-M 



SFK 

< R 1 

t 

5IXDUM • 

six 

(9) , . 

• 

CO 71 5200 

; 4 SKDCM 


• 

SK 

(R) 

• 

SP IOUM . ; . • 

SPI 

(9) 

, 

CO 71 5300 

•• > SVCCUM 


• 

SNC 

( R ) 







C 0715400 

■ • r • 











CO 7 1 5500 

• •* ' > 1 











C071 5600 

CC NM C N 

✓ REAL/' 










C071 5700 

* C A 

( 3 . 1 0 ) 


CAC 

13,10 


cLm 

(10) . 

CCMC 

(3.11) 

• 

00715800 

> * . DCMC 

(3.11) 


ETC 

(3,11) 


tre 

( 3 3 ) 

Vo MC 

(3.11) 

• 

C C7I £900 

-•♦.GAM 

( 3 . 68 ) 


K 



HM 

(3.10) ... 

HMC 

(3.10). 


, C C 71 6000 

* H^ON 

( 10) 


PHI 

(3,11) 


PL M 

(10) . 

QF 

<3.33 ) ' 

• 

CC716100 

; 4 QFC 

( 3. 33 ) 


CL 

(3,22) 


QLC 

(3,22) . 

RC MC 

(3.11 ) 

• 

C C 71 6200 

i T 






TH A 

(33) . 

THAO 

( 33) 

• 

C C 7 1 6 30 0 

4 THAC* 

(10) 


TEA w 

(10) 


XD IC 

(3.3.66) , 

XI 

(3.3.10. 

C0716400 

* XIC 

(3.3.10) 


>MA S 

(10) 


XMN 

(33.33) . 

XMT 

(3,3 . 1C) . 

CO 71 6500 

4 TIG 

( 33) 


FLA 

(3,20 


FLd 

(3.20) ., 

FLC 

(3.20) 

« 

C C 7 1 6600 

4. FLD 

(3.3.20) 


FL J 

(3.3.20) 


CAO 

(3.10) . 

X 10 

(3.3.10 . 

C0716700 

4 FLIFC 

(3.10) 


FLCRC (3,10 


FLAC 

(3.20) , 

flqc 

( 3i2C ) 

• 

CC 71 6800 

4 FLOV 

(20 ) 


2ETA 

( 20 ) 


FCF 

(3,3.40) , 

FCK 

( 3.40 ) 

• 

C C 71 6900 

4 " T IMEND 











CO 7 17000 











, 

CO 71 7100 

‘ . ■ 








-* 



C0717200 

C C N M C N 

✓real z/ 










CO 71 7300 

• 4 CBDLM 

(1.3) 

• 

ce 

( 3,1 C ) 

• 

CBCDUM1 1 ,3 ) . 

CBC 

(3.10) 


C071 7400 

* XMCCLM < 1.1 .9) 

• 

XMC 

{ 3 V3?, 1 0 ) 

• 

Ct»M3> 




CO 71 7500 












CO 71 760 0 





/ . 







C0717700 

. EQt.I VALENCE (ETM< 1 ) . THACC < 1 ) ) 



, ( XWN( 1,1) 

. AN GO ( 1 ) ) , 


CC71780C 

■4 

(XMN( 

1,3) 

• YNCO< 1 ,1 » 

1 ) > 

, ( XMN ( 1,6) 

. CNF ( 1, 

1 > ) 


CC71 7900 

m V 

( XMN( 1.8) 

.ET IC( 1 .1 ) ) 


, { XMN ( l , ) 0) , E TMC ( 

1 . 1 ) ) 

• ; 

C C 71 8000 

• 4’/ 

<FLG< 

1.1) 

. FLO N ( 111)) 


. It 

, (FUEH , l . 

1 ) , FLD ( 

1.1.1) ) 

• y 

CC.71 eioo 

4 ' 

( F LH ( 

1 • 1 t 

1 ) .FL J ( 1 , 1 

• 

1 > ) 

* 




CO 71 6200 

4 

(FG1. 

LINI T( 1 ) ) 



. ( C A ( 1 , 1 > , 

R1NIT ( 1 

)) 

• 

CC718300 


( C8DUM( 1 . 

l ) .R2IMTI 1 ) ) 

, ( AWORM 1 ) 

, I 1NIT ( 1 ) ) 

• 

CC 71 8400 

•, * 4 ■ 

( SCNDLN . IZIMT ( 1 ) ) 



, (TOHC(78) 

• SCXC( 1 

> ) 


CC 71 8500 










n - • \ 


CO 71 8600 












CO 71 e700 

' CIKENS'ICN MESS< 18) 








C071 8800 

IN TE ( E W 

kcn( 4 ) ; 

' c 

F X V. I 

, s'Tk--' 1 - >-■- 

* 

* ** «/ 

• C~ « li X/ 

• i tj : i N 

0 10uJ\ 

✓ 3M-.»00718900 

C I NE NS I CN OF K( 3 

.3 ) 








C C 71 9000 

V INTECEH 

51(10), 

S2 (10) 

.£3(10). SML 

,34(33) 




CO 71 9 1 00 

LOGICAL 

CTA1 N 









• 

„ CC 71 9200 

' , : ’ ■' 











CC 719300 












CO 7 19 400 

CAT A INR • I 30 » I AS/ 

• INER' • • 6CC Y • , 

< 

ASET*/ 

• 




• CO 71 9500 
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u u 


* IXM .1 IC .ICE . ICO/'X *,*IXC *.*C£N * • * CCR •/. 

* IEL .1 CL . I VT. IFR , ILO/'ELLE * . *COLX* . • VTIN* . 'FREE* . *LOCK* /. 

* ICF . IMA/ • CFCfi ' . 'MCKA' / , 

* I V A/ • VAR* */ , 

4 ISM/'SMAL*/. 

* I £ N / * END’/. 

4 NU.16L.ICG/* NO *.* ‘.'CAGE*/. 

* IFL .IMD/*FLEX* , 'MCOE •/ 

C 

C CEFALLT CONDITIONS 

C 

C SET LP CFTIUN DATA SETS FAKING NO ENGINEERING ASSUMPTIONS AND 

c ccmplTation is relative to inertial frame 

c 

INERF = .False. 

CO 1 L= 1 . NBOO 
I = L-l 


SFM I ) 

= 0 


SP I < II 

= 5K ( 

I 1 

SIM I ) 

= SM 

1) 

SC NCI) 

- SM 

I) 

SCR < I ) 

= SM 

I ) 

S X T = 

SMO ) 


sve = 

SM 0 ) 


SMAL = 

c 


SEL = 

0 


NFfiC = 



NC TC = 



NMC A = 

0 


NF KC = 

c 


see = 

3 


N62 = 

3*N61 


CO £4 

I = 1 . N6 

3 

SL K ( I» 

= 0 


SCI I ) 

= C 


SFLX = 

r 


I'M CDS 

= C 



CO 79 1=1. WOOD 
79 SFXMI I ) = 0 

NFLXE = C 
SFCC = C 
N0 c = 24N6UD 
CC 89 1=1, No2 
69 SCXCIII = 0 

CO 2 I = 1 . NF ER 
2 SFRC I ) = I 

CO 6 C 1= I .NMO 
SM A < I ) = 0 

ec SHU = i 

.. lO.-C. CALL CCFFACI SI .NMC.SMV » 

NM V = NFC 

C 

C NOTE 

'C • ’• CCR 1 LL I S EFFECTS ONLY FCR LINEAR OSCILLATORS , ' _ 

C INERTIA CROSS COUPLING ONLY FOR RIGID EDDIES 

FCR LINEAR OSCILLATOR TRANSFORMATION MATRICES FIXED 
SUETRACT THESE FRCF NON— AUG FEN TED SETS CONSTRUCTED 
CO 5 L=l.NQOO 
I = L-l 

CALL LNPACCS1 ,Nl . SCR( I » ) 


C 0 71 9600 
C0719700 
CC 71 9800 
CC 71 9900 
CO 720000 
CC 7201 CO 
CO 72 02 00 
CO 720300 
C0720A00 
C 0 720 500 
CO 72 0600 
TFAT C072C700 
C C 7 20 800 
CC72C9CC 
C072 1000 
C0721 100 
CO 72 1 20 0 
CO 72 1 300 
CO 721400 
CO 72 1 500 
CO 72 1 600 
CO 72 1 7 00 
CO 72 1 800 
C C 72 1 9 00 
C C 722 CO 0 
CO 722 IOC 
CO 72220C 
CO 72 2 30 0 
C C 72 24 00 
C0722500 
CO 72 2 60 0 
CO 72 2 7 00 
CO 722800 
C0722900 
C C 723 000 
C07231 00 
CO 723200 
CO 723300 
C0723400 
CO 72 3500 
CO 723 60 0 
CO 723700 
CC72380C 
CC 723900 
C 0 72 4 0 00 
C 0 724 1 00 
C0724200 
CO 724300 
CO 724400 
CO 724500 
' * ‘ CO 72 4 600 
C 0 72 4 7 00 
CO 72 4800 
C C 724900 
CC725000 
CO 72 E I 00 
CO 72 520 0 
CC 725300 
CC725400 
CO 725500 




.CALL LNPACI52.N2 . SL ) 

C0725600 


N3 = C 

C 0 725 700 


IF (N 1 .EC .0) GO TO 666 

C 0 72 5800 


CO 6 J- 1 .N 1 

C C725900 


1F1K2.EC.O) GO TO 66 7 

CC 726000 


CC 6 6d K= 1 .N2 

CO 726 100 


if ( s t ( j ) .Nt. S2(K i ) go tc eee 

CO 726200 


N3 = N3 + 1 

C0726300 


£3 (N 2 1 = SI I J) 

CC 726400 

666 

CCNT INUE 

CO 726500 

* 66? 

CONTINUE 

CC 726600 

6 

CCNT INUE 

CO 726700 

66 6 

CONT INGE 

CC 726800 


CALL C JFPAC ( S3 ,N3 .SC(- ( 1 ) ) 

CO 726900 

c 

CONTINUE 

C0727000 

c 


CO 727 1 00 


CO 1C L=l.NOOD 

CO 72720C 


I = L-l 

CC 727300 


CALL CNFACIS 1 .N1 , SIX! 1 ) 1 

CC 72 7400 


CALL UNPACIS2.N2 ,SR > 

CO 727500 


N3 = C 

CO 727600 


IF(N1 .EC.C) GO TO 11 1 1 

CO 72 7 7 00 


CO 11 J = 1 .N 1 

CC 72 7800 


IF(N£.EC.0) GO TO 1112 

C C 72 7900 


CO 1113 K= 1 • N2 

C072800C 


IF (S 1 1 J ) .NE. S2<K ) > GO TO 1113 

C0728100 


N3 = N3 ♦ 1 

C0728200 


£3<N2 ) = S 1 ( J ) 

CO 72830C 

1112 

CONTINUE 

C C 728400 

1112 

CCNT INUE 

C 0 72 6 50 0 

11 

CONTINUE 

CO 728600 

1111 

CONT INUE 

CO 728700 


CALL CCMFACt S3 ,N3 .S I X( I) ) 

C 0 72 880 0 

1 C 

CONT INUE 

C C 728900 

c 


C C 729000 

c 


CC 7291 00 

1 2 

READ ICC, ICD1 . ICC2, ICD J .1 ,NSET, C SI t J) , J=l , 10) 

C 0 7 29 200 


CT 1 ~s CT 1 + 1 

CO 729300 


IF1ICOI .EG.I6L1 GC TO 2C 

CO 729400 


IF ( I CC 1 .EQ .NO ) GO TO 21 

CO 72950C 


IF ( I CC l .EU ,IEM GC TO 21 

CO 729600 

2 C 

IF < I C02 ,EO. I AS) GC TO 22 

CO 729700 


IFIIC02.ECi.lEU) GO TO 23 

C 0 729800 


IF < I CC2 .60 . I CL ) GC TO 2A 

CO 729900 


IF< ICC2 .EG.IVT) GC TO 25 

CO 730000 


IFIICD2.EG.IFR) GC TO 26 

C0730100 


IFUCC2.E0.ILC) GC TO 27 

CO 730200 


IF ( I CD2 .EO.I MA ) GC TC 2d 

CO 730300 


IF ( I C02 .EG. ICF ) GC TC 29 

C0730400 


IF ( I C02 .EU .1 NR ) GC TO 20 

CO 730500 


.IF ( I CC2 .EU . I 80 ) GC TO 21 1VN. 

■ C0730600 


IF (I CC2 .EU.l VA ) GC TO 62 

CO 73 07 00 


IF < I CD2 .EG. I SM > GC TO 69 

C 0 730800 


IF I I CC2 .EG. I CO) GC TO 77 

C C 730900 

J ' * • '* j . 

'lFUCD2.EQ.IFLI GC fcT’e O' Jjl ^ 633 ?T0)W3 if 3«c- 

C0731000 


IF ( I CC2 .EG. I MO ) GC TO 90 

CO 73 l 100 

37 

PRINT 20C. CTI.ICD1.ICD2.1C03 

CC 73 l 200 


FG2 = .FALSE. 

C0731300 


RETURN 

CO 73 1 400 

3 C 

INERF = .TRUE. 

i 

t 

CO 73 1 500 



A41 



CO- TC 12 

' '2 1. INERF = .FAL SE . 

CC TC 12 

. 22 IF ( I CC3 .EG. I XM) GC TO 32 
;iF{ ICDS.EO.KC) GC TO 33 
t ‘ -rF(ICC3.E0.ICt) GC TO 24 
; -tF CI CC 3 . EU . I CO > GC TO 35 
CO’ TC 37 . 

■ 22 CALL COMFACI SI .NSE1 ,SEL) 

- OO TC 12 . 

C ‘ 

' HC ^FLXE = NSET - 
' CO 8 1 .!■= 1 • NdUD 

- 'SF >M< l ) = SI IT )- f. 

8 1 NMCDS = . NMOO S + SFXMII) 

C * CREATE TFE SET. SFLX 

li* = o 

-• CO Sf ,I = l.Ncll)D 
Sltl) = C 

IF (SFXHI I) .EQ. 0) CO TO 88 
11= Ilil 
SKID F I 
ae continue 

. v Call cgmfaci si .nflxb . sflx ) 
c Read in all flexiele acov modal data 

Call lnf al i s i . nsi . sflx i 
MN = C 
X M V = 0 

PRINT 2 C 1 

PRINT 242. < SI K ) .1-1 ,NS1 ) 

■ s to: e e n-i.Nsi 

"l = SltNSUl-I 1) 

■ READ 103, N. IMESSI J> ,J = 1 .18) 

PRINT 241, N. IMESSI J> ,J=1 ,18) . 

' IF ( I .EG .N) GO TO te 
. ; -PRINT 222 

eg 3 = .false. 


CC 731600 
C 0 73 i 7 00 
C O 731 800 
: C C 7 3 1 900 
C0.732000 
C O 73 2 100 
..CC732200 
. CC 732300 
CO 732400 
CO 732500 
C07.32600 
CO 732700 
CO 732800 
. - CC.732900 
CC 733000 
CO 7331 00 
, CO 733200 
CO 733300 
C073340C 
CC 733500 
C073360C 
CO 73 3 7 00 
CC.733800 
C C 73 3900 
C0734000 
■ CO 734 100 
. C,9 734200 
C 0734300 
• C0734400 
■■CC734500 
CO 734600 
, CO 734 70C 
CC73480C 
,CC73490C 
CC73500C 
00735100 
, , . CO 735200 


: return 

E6.SF7MI = SFXM(I) 


•<7-*- KF N N = NFER * MN 


' /■ i j . 


2 ; -4 i r - '■) ■' 


r PRINT 

22$. 

NF! 

PRINT 

224. 

MN 

TNT 

243 


- PRINT 

22t . 

MN 

> PR IN T 

243 


■ ' .PR IN T 

22t. 

MN 

-• PH INI 

243 


< . Pfi IN T 

22t . 


> PR I N T 

237. 

MN 


MN. IFLE(K.MN) ,K=1,J1 . I 


(FLCI 1 .L .MN ) ,L=l .3) 




C C 735300 
C073540C 



CO 87 

M= 1 

, SF XM I r ■ - 7 :^ 

„ CO 735500 


MMM = 

MM* 

♦ l 

CO 735600 


; MN' = 

MN + 1 


CO 735700 

■2 

i READ 

104 , 

FLUMI MN ) . 2E TA I VN ) 

CO 73 5800 


' READ 

104 , 

TrlAINFEfiPMN) .TRAC (NFER4-MN) 

C07359C0 


’■•READ 

1 04 , 

I FLA I K .MM , K = 1 ,2) 

CO 736000 


READ 

104 , 

(FLBIK-. MM . K= l ,3 ) 

CC 736 100 


READ 

1 04 , 

(FLCIK. MN ) .K= 1 .2 ) 

CO. 736200 


' RE AD 

104 . 

KFLDIK ,L .MN) .L = l .3) .K = l ,3) , . 

CO 736300 


•READ 

104 . 

I 1FLJIK ,L.MN) ,L= 1 .3) ,K=1 ,3) 

C 0 7364 0 0 

- . 

PR INT 

222 

, MN, MN .FLCMC MN) ,MN, 2ETAIMN) 

CC73650C 


CO 736600 

JJA ) 

C07367C0 
CO 736800 
. C073690C 
‘ C0'737C0C 
CO 737 1 00 
CO 737 200 
CO 737300 
C 0 737400 
C 0 73 7500 


A-42 


r> n 


PRIM 236. (FLCI3.L ,MN ) ,L = 1 ,3> 

PR I N T 243 

PR INI 23£. (FLJd >LiPM *L = i >3) 

' PRINT 240. MM. (FL JI2.L .MM .L = l .31 . 1 
PRINT 23£ . IFL JU.L.H) .L = l .3) 

•• PRINT 215 

IFIMMM.NE.2) GO TC £7 
PRINT 2 C 1 
' • , HMV = 0 

"87 CONT INUE 
" 6£ CONTINUE 
GO - TC 12 

CONSTRUCT CENTRIPETAL ANC CCRIJL13 MODE COUPLING CCDE WORD 
* 3C CONTINUE 

c check if ‘flexible* read vet 

IF INMOOS.NE. 0) GU TO 91 
1 S4 PRINT 232 

;fg2= .false. 

PE TURN 

■ 9 1 CC 92 . 1= l.NMCDS . ; 

92 SCXC < I ) = 0 

CO 9 2 i = l.Nt»CO 

93 S2 1 I 1 = C 
NS 2 =0 

CO 94 J = 1 , NbOO ■ /x 

IF(SHJ).EO.O) GO TO 94 
N S 2 — N E 2P l 

S2 ( N E 2 > = J 
: 9 4 CO NT 1NUE 

.CALL CGFPACI S2.NS2 ,SFCC ) 

PR INT 2 C 1 

; ‘ ' PRINT 244, ( S2I I ) .1=1 ,NS2 ) 

C '■ READ IN NUDE COUPLING CATA. SET UP COUNTERS 
NN = 0 
KF = 0 

' CO ISO K = 1 .NBOO 

IF (SFXMIK) .EQ.OI gc TO ISO 
■ IFISUK1.NE.C1 GO TO 151 

C NO CPCSS coupling TERMS. UPCATE MUOE NUMBER COUNTER MN 

MN s KNtJFXMlKl ■ 

GO TC ISC 
15 1 S1K - 3 1 ( K ) . 

• CO l S 2 I = I . S 1 K 

read 10S . Mo .N6 . K 6 ■ - ' 

IFIK.NE.KB) GO TO 154 
MNN = MN ♦ Nfi 

CALL UNPAC (S2 .NS2 .SCXC I MNM ) 

NS £ = nS2f I 
, t 7 S2 ( N S 2 ) - MB 

. ' l " CALL COMPACI S2.NS2.SCXCIMNN) > 

’ KF = KF ♦ 1 " ' 

READ 104. I IFCFC I I , JJ ,KF ) .J J=1 .J> .1 1 = 1 i JJ 
r r ...PRINT 24 3 

PRINT 2 4 £ , IFCFIl , JJ.KF) , JJ = l .31 ’• ' ' = 

PRINT *47. ME .Ni3 , KE . (FCF (2 , JJ .KF > , J J = 1 . 3) ,K ,KF 
FRINT 2 4 £ , (FCF <3. JJ.KF) , JJ=I .3) 

PRINT 243 

PEAD 134. (FCK ( I 1 .KF ) , I 1= 1 .3 ) 

PRINT 2 4 £ . MB.NB. KE , (FCKIJJ ,Kr ) , JJ=1 . J) .K.KF 


CO 737600 
CO 737700 
C0737800 
CC737900 
C C738000 
C0738 100 
CO 738200 
C0738300 
.CO 738400 
CO 738500 
C 0 7 3860 0 
CO 738700 
CO 738800 
C C 738900 
C 0 739000 
CO 739 100 
CO 73920 C 
CO 739 300 
C 0 739400 
C C 739500 
C 0 739 60 0 
• ,C0 7397C0 
CO 73980C 
CC 739900 
CC740000 
CO 74 0 100 
C 0 74 0200 
CO 740300 
, CO 740 400 
C 0 740500 
CO 740600 
CC740700 
C 0:74 0 80 0 
C C 74 0 900 
C 074 l 000 
CO 74 1 100 
C0741 200 
C0741 300 
CO 74 1400 
. CC 74 1500 
. C C 74 1 600 
C0741 700 
C0741800 
C 0 74 1 90 0 
CO 742000 
C0742 100 
CO 742200 
. CO 742300 
00742400 
CO 742500 
•'’CO 742 600 
CC742700 
CC 742800 
l CO 742 900 
C C 74 3000 
C0743100 
C 0 74 3 200 
C 0 743 300 
'CO 743400 
• C 0 74 3 500 


A^3 



PRINT 243 


1 5 2 

CONTINUE 




CHECK AND OUTPUT INTEGER ARRAYS 
KKF = KF-S1 I K) 

FC* BODY K 

: 


SFXM1 = EFXM(K) 
CO 163 I=1,SFXMI 




FN = KN.l 




CALL UNP AC l S2 ,NS2 .SC XC I MN ) ) : 




IFINSZ.NE.O) GO TO 155 




PRINT 242 


* 


PRINT Z49. MN 

' 



CO TC l S3 



lit 

CO, l So J=l »N S2 




F6 = 52INS2F 1-J) 

KKF = NKFF1 

PRINT 2SC . . K .MB . MN .KKF 



lse 

CONT INUE 



1*3 

CONTINUE 



1 5C 

CONTINUE 




CO TC 12 



. 2 4 

CALL CCNPACI SI .NSET.SXT) 

'GO TC IZ . 



2 e 

CALL CLNPACI SI ,NSET , SVC ) 



. *6 2 

CO TC IZ 

CALL CCFPACI SI .NSET ,SMV) 
NFV = NSET 
GC TC IZ 

> 


6 5 

CALL CCMFACI Si .NSET.SMAL ) 
GO TC 12 



7 7 

SCG = NSET 
CO 99 1=1, SCG 



9<3 

PE AD 10 1, Sell) .TEM 
TUG I SCI 11) = TEM 




C CHECK IC UN T H A H ( SC ( I ) ) j FUST dE ZERO. RESET IF NUT.’ 

C COOING FQR IMPULSE EFFECT DUE TC NON-ZERO THAO NUT INCLUCEC 

CO ‘7 t 1 = 1. SCO 

IF ITFAO ( SCI I I ) .EO .C . 0) GC TC Id 
TH AC (SC Cl > ) a 0.0 

Ffi INT 2JC. SCI I ) - ' 

7 6 COM INUL 
CO 1C 12 
2£ CTZ = CTZ+1 


JDCNE = CT2+NSET-1 
IF IC IZ .GT . JOCNE) GC 
CO 36 J=CT2.JOGNE 
3E EFR(J) = SllJ+l-CTZ 
S7C 1 CCM INUE 

CTZ = CTZtNSET-1 


TC 5 C 0 1 


CC TC 1Z 

= CT3+1 > '• T = « ’• •- 

JOCNE = CT3FNSET-1 
'lF IC 13 .GT . JDCNE) CC TO 5CC2 
‘.“CO 3C J = CT3.JOONF. 

ZV’ELKI J) '='"il?J r i\-CT3).'.> 

5 CC2 CCM JNUE 

C T 3 = CT3 + NSET-1 

CO TC IZ 
26 CM = C T 4 -*• l 

JOCNE = CT4<-NSET-l 


V *■ ' - 




CO 54 3600 
CO 743 700 
CO 743800 
CO 74 3900 
C 07440 00 
007441 00 
CO 744 200 
C0744300 
CC744400 
C0744500 
CO 744600 
CO 74 4 7 00 
C C 74 4 800 
CC 744 900 
C0745000 
CC 745 l 00 
CO 745200 
CO 745300 
CC 745400 
00745500 
CO 745600 
CO 745700 
CO 74 5800 
CC 745900- 
C 0 746000 
C C 74 6 1 00 
CO 746200 
CO 746 300 
CO 746400 
CO 746 5 00 
CO 746600 
CO 746 7 00 
CO 746800 
CO 746900 
C C 74 7000 
CO 74 7 1 00 
CO 74 7200 
C 0 74 7 300 
CC74740C 
C 0 74 75 00 
C 0 74 7600 
CC 747700 
C C 74 7 800 
C C 74 7900 
C C 74 8000 
C0748100 
CO 748200 
CO 748300 
CO 748400 
CO 74 8500 
CC 748600 
-j ■'£!(> 74 6 7 00 
CC 748800 
CO 7 4 8900 
CC 749000 
C0749100 
CO 749200 
C0749300 
CO 749400 
CO 74 9500 


A-44 


on n non 


4 C 
50 0 2 


29 


4 l 
5004 


3 2 
34 


2 1 


4 2 


44 


C CM- 

C ' 

c 

It 


IF (Cl 4 .GT . JUCNE) GC TC 5C03 
CO 4 C J = CT4 . JDONE 
SMA(.J) = SHJH-CT4I 
CONT INUE 

CT4 = CT 4 + NSE T - 1 

GO TC 12 

CT £ s CT5+1 

JCCNE = CTS-t-NSET-1 

IF (C75.GT.JDCNE) GO TO 5C04 

DO 41 J=CT5. JDONE 

SFK(J) = Sl(JPl-CTS) 

CCNT INUE 

CT £ = CT5+NSET-1 
CO TC 12 

CALL CC M P AC ( £1 «NS ET . SP I ( I > > 
CO TC 12 

CALL C o N P A C ( 51 iNSET • S I X ( I 1 1 
CO TC 12 

CALL CCMFAC1 SI .NSET .SCN( II ) 
GO TC 12 

CALL CCNFAC( SI .NSET .SCR ( I ) > 
GO TC 12 
CT 1 = o 

IF (02 .EC.O) GC TC 42 
NFAC = C T 2 
CT 2 - 0 

IF(CT2.EC.0> GO TC 43 
NCTC = C T 3 
CT 3 = 0 

IF (CT4.EG.01 GO TC 44 
NMCA = C T 4 
CT 4 = 0 

IF(CTS.cC.O) GC TC 45 
NFkC = CT5 
C T S = 3 

CONT INUE 


COTA 
INI 
CC 3 
CO 3 
SXM ( 
CC N T 
CE FI 
SD = 
DEF 
TE 
.SML 
CALL 
-C-YCL 
IF (N 
CO 4 
, K = 
CE F 1 
CALL 
PI CK 
1GCT 
CC T 
CALL 


IN CLEMENTS OF ARRAY SXN 


WHICH DIRECTION COSINES ARE 
WHICH SMALL ANGLE UR EULER 


tialize both sxm ano ih arrays 
K — 1 . NbCD 
1 = 1.3 
I . A ) = 0 
INUE 

NE CCNTIGUCUS PAIRS FOR 
5R-SMAL-SEU 

1NE CGNTIGLOUS PAIRS FOR 
ChNICUES TO BE USEC 
= S R — S D 
LNP AC (SI .NS1 .SML) 

E THROUGH ELEMENTS OF SML TU DEFINE 5XM ARRAY ; _ , 

SI. EC.C) GO TC 5C8C 

NK=1 . N S 1 

S 1 ( K K ) c »> - L 

NE NOMINAL STATE TRANSFCRMATION FRCM BODY JCCMtC) .TO BODY K 
TRNSPS ( XMT ( 1 . I . K ) I 

CUT G I MEAL CONFIGURATION AT HINGE POINT 
C = PC ON ( K ) P 1 
C l 13.14.15.1 t). 1GLTC 
TRNSPS ( XMT ( l . I . K1 ) 


TC BE 

angle 


K-l 


CO 74 9600 
CO 740700 
CC 749800 
C074990C 
CC 75000 0 
CO 750 100 
CO 750200 
C 0 750 30 0 
CO 750400 
CO 750500 
CO 750600 
CO 750700 
CC75C800 
CC 750900 
CO 751 000 
C0751 IOC 
C 0 75 1200 
CC 75 1 300 
C 0.7 51 400 
C0751 50C 
CO 751 600 
CO 75 1 7 00 
CO 751800 
CC 751 900 
C0752000 
CO 752 100 
CO 752200 
CO 752300 
CO 752400 
C 0.752 50 0 
.CO 752600 
CO 75 2 700 
C0752800 
CO 752900 
CC75300C 
C 0 75 3 100 
CO 753200 
CO 753 30 0 
C0753400 
CO 753500 
CO 753600 
CO 753700 
C 0 753800 
C0753900 
USEDCO 754000 
00 754 IOC 
CO 754200 
CO 754300 
CO 7544 00 
CO 754500 
C 0 754600 
CO 754 7 00 
CO 754000 
t C C754900 
' CO 755000 
CO 7551 00 
C 0 7552 00 
CO 755300 
CC 755400 
CO 755500 


A-45 



■ CQ TC 4 
IS NGA = J 
■ ‘ : r M . * EOF CKJ 

L = SOL ( K > 

CALL VECTKn {QF(1 .M.Xt'TU ,1 .iC) .GFKU.l )) 

CO 7 S 1 = 1,3 
7S CFK( I .2 ) = QL(I.L) 

CALL VECHOS ( QFK ( I . 1 ) .CFK< 1 .2 7 ,OFK ( 1 .3 ) ) 

CC TC 7 

14 NGA = 3 

M = , Stir (K) 

Ml ' = V ♦ 1 

CALL #:CI(<N (UF ( 1 ,M) . XMT < 1 , 1 ,< > , JFK< 1 . 1 > ) 

CC 8 l = 1 , 3 
e CF K ( 1,27 = OF(I.Ml) 

CALL VECFGS <QFK< 1 .1 ) ,CFK< l .2) ,OFM 1 ,J» ) 
i GC TC f 
1 2 NG A . = 3 
. M = SO F IK) 

0 1 = M + 1 

. , M 2 . = M 2 

CALL VECTKN (OF( 1 .Ml ,*KT ( 1 . I .K ) ,OFK ( 1 , 1 > ) 

. ico' 9 1=1,3 

. « CFK( 1,3) -= UFCI.M2) 

CALL VcCFUS (OEM l .3 > ,CFk( 1 ,1 > ,OFK< 1 ,2 > ) 

GO TC 7 

.'.7 IF (NGA .EC. 3) GO TC 16 
. CO. 1 7 N= 1 ,NGA 
CO 1 7 I = 1 . 3 

. (F<GFK( I .NJ.NE.O) GO TC- id 
GO. TC 17 

.16 IF UQFKI I ,N) .NE . 1 ) GO TO 19 

1 .Xfl A ,K ) = I 
CC TC 17 

. I ? IF (QFK< I ,N) .NE .-1 ) GO TU 58 

.VSXK.U.O = -I ’• 

, - , fee . T C 1 7 

,56 CONTINUE 

C CCMS FENS ONLY IF FREE CCGRCINATE AXES NOT ALIGNEC UTH - 

C BCDY K FIXEC AXES IN NOMINAL STATE. 

C ’ SMALL ANGLE OF EULER ANCLE METHODS CANNOT 8E USED, INCLLS10N 

C CF THIS CAPABILITY OF LIMITCD VALUE SINCE IT mCLLD SACRIFICE 

C COMPUTATION SPEED ANC MEMORY STORAGE. 

c „ ■ pet k sack in so and celete it from seu ur smal 
’ S2 Cl ) = K 

call CCMFACI SC . 1 .AKI 
SD = SO ♦ NK. 

CALL LNPACC S3.NS3 .SEU) 

IF (NS3 .EC. 0) GO TO 5020 
CO 7 I J J= 1 , NS 3 

1 V'/j = S3( J J) • 

IF(J.NE.K) GO TO 71 ’ ' ■ ~ c ~ ' 

‘ SEL = SEL - NK • ’• : 

--. r " 4°- - Tc »«• 

v '7 l' 'cONT INUE - ' '-"I • uii:.. 

50 2 0 CGN T INOE 

CALL UNPACI S3.NS3 .SMAL ) 

IF (N53.EG.0) GO TC 16 
CC 72 JJ=1.NS3 
••••' C J = SJ( JJ) 


CO 75560 C 
CO 755700 
C 0 75580 0 
CC 755900 
CC75E000 
CO 756100 
CO 756200 
CO 756300 
CO 756 400 
CO 756500' 
CC 756600 
CO 756700 
CO 756800 
CO 756900 
CC 757000 
C0757100 
C C 75 7200 
CO 757300 
CO 757 40 0 
CO 757500 
CO 757600 
C0757700 
CO 75 7 80 0 
CO 757900 
C0758000 
C 0 758 10 0 
CC 758200 
CO 75830C 
CO 758400 
CO 758500 
CO 758600 
CO 758700 
CC 75880C 
CC 758900 
CC 75 9000 
• CO 759 100 
CC 759200 
C 0 75 9300 
00759400 
CO 759500 
CC 759600 
CC 7597C0 
CC 75980C 
C C 759900 
CO 760000 
CO 76 01 00 
CO 760200 
CC 780300 
CC76040C 
CO 760500 
CC760600 
’ CO 76 C 7 00 
CC 760800 
CO 76C900 
i G 0*76 1000 
CC 76 1 1 OC 
C07612C0 
C076I 300 
CO 76140C 
C076I5C0 
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IF ( J «N d • K ) GO TU 72 


C 0 76 1 600 


£M*L - £ KAL - NK 


CC 76 l 700 


GC TC 1 t 


C 0 76 1800 

7 2 

CGM INU*£ ... 


C 076 1900 


GO TC 1 c 


CO 76 2000 

1 ? 

CCNT INUC 


C 0 762 1 00 


GO TC 1 c 


CO 762200 

• 4 

CONTINUE 


CO 762300 

50 d C 

COM INUE 


C 0 76 2400 




CO 762500 


NAKE SURE ALL ANGLES CALLED FUR BY SAM M ILL 

BE COMPUTED ' CC 762600 


CO 3C A = l.NdOD 

, 

C 0 76 2700 


IF (3>m 1 .KJ.EQ.C) GO TC se 


CO 762800 


NDCNE = 2-PCON(K) 


C 0 762 900 


CO 45 L L - 1 t MO ONE ... , 


CO 763000 


L-= LL-1 

• ! 

•' CO 763 I 00 


N . = EOF IK) L 


CC 763200 


IF (NFRC.cO.O ) GO TC 5021 


CO 763300 


.CO 5 7 N = 1 .NFRC 


CO 763400 


IF ( M .E J . SFR( N) ) GC TO 49 


• •' CO 76 3500 

57 

CONTINUE 


, . , C0763600 

50 2 1 

CONTINUE 


CC 763700 


COWE HERE IF M NUT IN SFR 


CO 76 3800 


NFRC = NFRC + l 


; , ' CC76390C 


SF R ( N F R C ) — M 


• " •' C C 764 0 00 

•45 

CCNT INUE 


. . CO 764 100 

3 t 

CClNT INUE 


" ‘ CO 764200 




CO 764300 


NAKE SURE TRANSLATION CCNFCNENTS OF C.M. 

OF 

BODY l (HINGE POINT. 0)00764400 


ARE CuNFUTtC SO AS TO BE AELE TO DEFINE 

CB(l). NEEDED FOR INER T I A CO 764500 


ANGLLAfi MOMENTUM ANC ENERGY CALCULATION 


CO 764600 


NDCN1 = SGF(NBl) 


CO 764 700 


NOCNE = SUFI NB I ) + 2-PCCN ( Ne 1 1 


CC 764800 


IF (MCC.MI .EU. C) GO TO 5032 


C C 764900 


CC 72 M=MOON I .MDGNE 


C C 765 000 


' IF (NFRC .EC1.0 ) GO TC’ 5022 


. CO 7651 00 


CO 74 N-l.NFRC 


CO 765200 


IF (M .E J.SFRI N) ) GC, TO 73- <>. . ■ 


, CO 76b 300 

7 4 

CONTINUE 


C 0 7654 00 

5022 

CCNT INUE , 


„ C0765500 


' N F R C = N F R C+ 1 


CO 765600 


SFR(NFRC) — N 


■ CC 765700 

7 2 

CCNT INUE 


CO 765800 

5032 

CCNT INUE 


C C 765900 




CC 766000 


NAKE SURE ALL POINT NASS COORDINATES IN 

SQF 

ARRAY CO 766 1 00 


CALL UNPACISl .N1 .EL) 


CO 766200 


1FIN1.EC.0) GO TO £Cia 


CO 766300 


co g t 1 1 = i .n i 


C 0 7664 00 

C f .-i 

I = S1III) 


CO 766500 

0 

'NDCN I = SUFI I ) 


. ■” *■ ' CO 766600 


MDCNE = SUFI I) ♦ £ - PCCM1) 


, C076670C 

. 

IFIMCCN1 .EU.O) GO TO 5Clt 


C 0 766800 

( C‘v < 

-CO-S7 M=NOON I .MOUNE 


3 ' , ' CC 766900 


IF (NFRC .EU .0 ) GO TC 5017 


* C 0 76 7.000 


CO 9.E N=1.NFRC 


CO 767 100 


IF <M .EG.SFRCM > GC TO 97 


CO 767 200 

ye 

CGNT INUE 


CO 767300 

50 1 7 

CONTINUE 


CC 767400 


NFRC = NFRC ♦ 1 


CO 767500 
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SF F ( NFHC ) =' M ■ 

. 97 CONTINUE 

5oie continue 

9€ CGNTINUE 
5016 CONTINUE 
C 

C • FIND ALL MOMENTUM WHEELS IN THE NEST K.- 1 ; K = 1 . 2 . . . . . NBOD 
CC 6C 11=1 (NBOD 
1=11-1 

CALL UNFACCSl .N1 . SKI I ) ) 

CO 6 7 J = 1 , l C 
67 S2 <J ) = C 
N2 = C 

IFCNMD.EC.O) GO TC 5023 
CO 66 J = 1 t N Mu 

IF < .NCT .CTA1 N( MU< J ) . SI .N1 > ) GJ TO 66 
N2 = N2 ♦ 1 

S2 ( N £ ) = J 

66 CONTINUE 
5023 CONTINUE 

' CALL CCNFACC S2 .N2 .SMC ( I ) ) 

66 COKT INUE 
C 

C IF - COMPETING FRAME BODY 1 DELETE LABEL 1 FRCM SVC 

• CALL UNPACCSl .NSET.SVD) 

IF < I NEFF .OH. SI (NSET I .EC . C I CO TO 76 
NSET = NSC T - 1 . 

CALL CCMPACC SI .NSET.SVD) 

76 CONT INUE 
C 

C ALL TRUNCATED SUMMATIONS DEFINED 

C • PF INT THEM OUT 

C 

•PR INT 201 
lF(INERF) Gu TC 46 
PRINT 2.C3 

GO TC 47 ' 

46 FH INT 202 

47 PRINT 2 C 4 
FRINT 205 
PRINT 206 

CO 46 11=1 .NBOD 

1= 1 1 - I 

CALL UNPACI 51 .NSE T.SKC I ) ) 

FRINT 2 C 7 • I .( SI ( J) . J=1 .NSET) 

CALL UNPACC SI .NSET . SMC ( I II 
PR INT 222. I . ( 51 ( J ) . J= I . NSET ) 

FRINT 224 

CALL LNPACCSl .NSET.SPI ( I ) ) 

' ‘ FRINT 2 C 9 . ( St < j > i J=1'.NSET > 

CALL UNPACISl .NSET, SIX! I )) 

PRINT 2IC, ( SI ( J) . J= I . NSET) 

CALL UNPACC SI .NSET ,SCN< I ) ) 

FRINT 211. ( SM J ) . J = l.NSE T ) ’ ’ ‘ - 

CALL ONPAC ( SI .NSET, SCR ( I ) ) 

FRINT 212. < SI < J) . J= 1 . NSET ) 

46 FRINT 225, I 
FRINT 2 C 1 

CALL UNPAC ( SI .NSE T ,SD) 

IF (NSET .EQ .0 ) GO TO 5CC5 


CO 76 7600 
CO 767700 
CO 767600 
C C 767900 
CC 768C00 
CO 768 1 00 
CO 768200 
CO 768300 
CO 768400 
CO 768500 
CO 768600 
CO 768700 
CO 768800 
C 0 768900 
C 0 769 000 
CO 769 1 00 
CO 769200 
CO 769300 
C 0 7694 00 
CO 76950C 
CO 769600 
CO 769700 
CO 769800 
CC 769900 
C C 770000 
CO 770100 
C 0 77 02 0 0 
C 0 77 030 0 
CC 770400 
CC77050C 
CO 770600 
C07707C0 
CO 77080C 
C O 77 0900 
C C 77 10 00 
C0771 100 
CO 77 I 200 
CO 771300 
C0771400 
C077 1500 
C 0 77 1 60 0 
CC 771 70C 
CO 77 l 800 
CO 771900 
CO 772000 
CO 772 1 00 
CC 772200 
CO 772300 
CO 772400 
CC 772500. 
CO 772600 
C 0 772 700 
CC 772800 
CO 772900 
CC7730CC 
CC 7731 CO 
CO 773200 
C 0 77 330 0 
C 0 77 34 00 
CO 773500 
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CC 5C 1=1. NSET 

5 C PRINT 214. S 1 ( I) . JCONI SI ( I ) ) 

, PRINT 215 

50C 5 CONTINUE 

(ALL LNPACISl.NSfcT.SMAL> 

1FIN5ET .Eu.O > GO TC 50C6 
CO 5S I — 1 • NSET 
5 9 PRINT 22E. S 1 ( 1 ) . JCCNI SI < I 1 ) 

PRINT 21£ 
soce continue 

CALL UNPACISl .NSET, SEU> 

IF INSET. EO.O> GO TO 5CC7 
CO 7 C 1 = 1 .NSET 

7 C PRINT 22S. S 1 ( I ) , JCONI SI ( I ) > 

PR INI 2 1 E 
5CC7 CONTINUE 

CALL UNPACCS1.NSET.SXT> 

IF INSET .EO .0 > GO TO 5CC8 
CC £1 1=1, NSET 

5 1 PR IN T 2 1 6 . SI 1 I > 

PRINT 215 
5cce continue 

CALL UNPACISl .NSET, SVO) 

IF INSET. EO.O ) GO TC 50C9 
CO 52 1=1 .NSET 

£ 2 PR INT 2 17 . SI 1 I > 

PRINT cl£ 

£ 0 C 9 CONTINUE 

C PUT ARRAY SFR IN SEQUENTIAL CRDER 

CO 6 1 1=1. N63 

6 1 SA l I ) = C : 

IF INFRC .EO.O > GO TC 501C 
CO 62 1=1.NFRC 
6 2 £4 I SFR I 1 > ) = 1 

50 1 C CONTINUE 
K = C 

CO 64 1=1. NB3 
IF (S4I I > .EU. C > GO TO 64 
K = N ♦ 1 
SFFIK) = I 
64 CONT INUE 

IFINFRC.EQ.O) GO TC 5011 
CO £2 I=1.NFRC 
£2 PRINT 216. SFRIl) 

PRINT 2 1 £ 

501 1 CONT INue 

IF INCTC.EO.O) GO TC 5012 
CO 54 1=1 .NCTC 

£4 PR INT 2 IS. SLK ( I > 

FR INT 2 IE 
5012 CONTINUE 

IF INFKC .EO.O ) Gu TC 5013 
CO 5 £ l = l,NFKC 
5£ PRINT 22 C , SFKII) 

PRINT 2IJ 
5012 CONTINUE 

CALL UNPACISl .NSET .SMV) 

IF (NSET. EO.O) GO TC 5014 
' CO 65 1=1. NSET 

6 £ FR INT 2 12. SKI) 


CO 773600 
CC 773700 
CO 773800 
C C773900 
CC 774000 
C C 774 I 00 
CC 774200 
CC 774300 
CO 77 4400 
CO 774500 
CC 774600 
CC7747C0 
CO 774800 
CO 774900 
CO 775000 
C0775100 
CO 7752 00 
C077S300 
CO 775400 
CO 775500 
CC 775600 
C0775700 
CC 775800 
CO 775900 
C 0 7760 00 
C0776100 
CO 776200 
CO 776300 
CO 776400 
CO 776500 
CO 776600 
C0776700 
CO 776800 
CO 776900 
CO 777000 
CO 777100 
CC 777200 
CO 777300 
CO 777400 
CC77750C 
CC 777600 
CO 777700 
CO 777800 
CO 777900 
C C 77 8000 
CO 7781 00 
CO 778200 
CO 778300 
CO 77 84 0 0 
C0778500 
CC 778600 
CO 778700 
CO 778800 
CO 778900 
CO 779000 
CO 7791 00 
CO 779200 
CO 779300 
CO 779400 
CO 779500 
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PRINT 21 5 

5010 continue 

IF INNOA .EO.O ) GO TO 5015 
CO 58 I=1.NM0A 
St PR IN T. 22 1, SM A ( I » 

PRINT 215 
5015 CCNTINUE 

IF(SCG.EC.O) GO TO 83 
CO 82 I=1.SCG 

82 PRINT 221. SC ( I) » TUG( SC ( 111 
82 CONTINUE 
CT1 = 0 

100 FORMAT (3A4. 13 .1 1 15) 

10 1 FORMAT I 15. D 15.5) 


102 FORMAT I 15. 2015.51 CC 781000 

103 FORMAT (I5.18A4) C0781100 

104 FORMAT <2015.51 ' . C0781200 

105 FORMAT <5151 CC781300 

20 C FORMAT (• IDENTIFICATION CODE (MOT REC0GNI2EC IN SUBROUTINE INCPT. CC781400 

* INPUT OPTION CARD*. 14.* CCDE READ IS *,3A4) CC78150C 

201 FORMAT C • 1 • 1 C 0 78 1 60 0 

202 FORMAT < 10X. 'CCMPCT ING FRAME TAKEN TO BE THAT FIXED I NERT I ALL Y • ,✓/ C C 78 1 700 

4/1 CO 78 1 80 0 

203 FORMAT < 10X, 'COMPETING FRAME TAKEN TC BE THAT FIXED IN BOCV 1 • . // / C C 78 1900 

* 1 CC 732000 

204 FORMAT I 20X. • TU, SPEED CP CCMPuTATICN VARIOUS TRUNCATED SETS CF EODCC782100 

7Y LABELS HAVE BEEN DEFINED*) CC782200 

205 FORMAT ( 54X . * THE SPECIFICATION UF THESE SETS PERMITS ENG INEEF. INC JCO 782 300 

4 UDGE IcNT TU* 1 CO 782 400 

2C8 FORMAT ( 28X . * BE INTRCDCCEC INTO THE FORMALISM AND MODELLING • . / / / 1 CC 78 25 CO 

2C7 FORMAT ( 30 X. • 600 Y LAOELS OF BODIES IN NEST • , 13 , 3X . 1 C I 5 1 C073260C 


2C7 FORMAT ( 30 X. • 600 Y LAOELS OF BODIES IN NEST • , 13 , 3X . 1 C I 5 1 C073260C 

2C8. FORMAT (2CX. 1CI5./1 CC782700 

209 FORMAT ( 20X . *P SUE DO INERTIA TE NSOR S * . I 3X , I 0 I 5 1 CC78260C 

2 1 C FORMAT ( 30X. ■ INERT IA CROSS COUPLI NG * . 1 3X , l 0 I 5 1 CC782900 

211 FORMAT (30X, 'CENTRIPITAL CRCSS COUPLING* .9X. 1015) CC783000 

212 FORMAT (30X. 'CORIOLIS CRCSS COUPL I NG • , 1 2X . 1 0 l 5 1 C07831CO 

213 FORMAT < 10X. ‘MOMENTUM thEEL'.Ui 1 IS ASSUMEC TO BE VARIABLE SPEED CC78320C- 

4 *1 CO 783300 

214 FORMAT I 10X . *RELA T I VE ANCULAR DI S PL A CEMENT BETWEEN dODIES*. 13.* ANC0783400 

4 C * .13. • IS COMPUTED VIA INTEGRATION OF DIRECTION COSINE EOUAT IC.NS • CO 783500 
V) CO 783600 

215 FORMAT </✓//> C0783700 

218 FORMAT <10X. • THE ELEMENTS CF COLUMN*. 13.' DC WN TU THE C1AGGNAL IN CC733800 

♦THE SYSTEM INERTIA MATRIX CF DYADS ARE ASSUMED TIME VARYING') CC73390C 

217 FORMAT ( 1 0 X . • VEC T CK S ANC CYADS FIXED IN BODY*. 13.* ARE ASSUMEC TIMCC784000 

♦£ VARYING IN THE FRAME OF CCMPUTATICN •) C0784100 

218 FORMAT < 10X* D I SPL ACEMENT ABCUT UR ALONG FREE VECTOR*. 13.* C C MFC T ED C C 78420 0 


4 • ) 

219 FORMAT (10X. 'CONSTRAINT 1CRCUE ABOUT UR ALUNG LOCKED VECT0R*,I3 
4CCMPL TED ■ 1 

22C FORMAT < 10 X . *CCNS TR A I N T FORCE AT HINGE POINT*. 13,* COMPUTED 

221 FORMAT ( 10 X, "ANGULAR POSITION OF MOMENTUM WHEEL*. 13.* CCMPUTEC 

222 FORMAT ( 30 X . • MO ME N TUM WHEEL LABELS IN NEST * . I 3 , 3X . 1 0 I 5 1 

22,4 FORMAT 120X. 'PRIME CONTRIBUTOR'S TO CCMPUTAT ICN OF *1 

22s’ FORMAT < 20X. 'FOR THE ECuVt lCN'OF M&TltlN 1)1=* NES T • > MVf * 

228 FORMAT < 10X. 'RELATIVE ANGULAR DISPLACEMENT EETwEEN BODIES*. 13, » 

♦ C * .12,* IS COMPUTED VIA SMALL ANGLE ASSUMPTIONS •> 

229 FORMAT < 10X, ‘RELATIVE ANGULAR DISPLACEMENT EETWEEN BODIES*. 13.* 

♦ D * ,13,* IS COMPUTED VIA EULER ANGLE TECHNIQUES *1 


■CONSTRAINT TCRCUE ABOUT UR ALONG LOCKED VECT0R*,I3,' 


CC 784300 
' CO 7844 C 0 
CO 784500 
1 CO 784600 
1 CC7847C0 

CC7848C0 
C C 784900 
Ml C r C 7^5000 
ANCC785100 
CC78520C 
AN C0785300 
CC 78540C 


230 FORMAT <1CX.*NUTE: THAC(*,I2.*1 


INITIAL RATE CONDITION RE SE T CO 785500 
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* TC ZERO. St E SUB INOPT AND KA1N •) C078S600 

231 FORMAT ( 10X. •MOTION ABOUT FREE VECTOR*. 13.* UNCAGED AT T= • , C 1 £ . £ i C0785700 


232 FORMAT ( • 


MOCAL DATA CUT CF SEQUENCE *) 


CC 78S800 


'223 FORMAT (• MODE* . I2.2X , • FLCM(*,12.*) = * . Cl 2 . 5 . 5X . • Z ET A ( * , 12 . • ) - C C 788900 


♦ • . Cl ; 


.3 ) 


C C 786000 


2 2 A FORMAT (• FLAT*. 12.*) = * . 3C 1 2 . 5 . 3X . • (BODY*. 12.* FIXED COO RC IN A TE 00 78 6 1 00 


*S> 


) 


CO 786200 


2 3 8 FORMAT (• FLBl'.I2.<> = • .3D l 2 .5 . 3X . • (BODY*. 12.* FIXED COORD IN ATE CC 786300 


♦ SI 


I 


CO 7864 OC 

.236 FORMAT (• FLC(*.I2.*> ='.3012.5. 3X • * (dJDY*.I2.* FIXED COORD IN A TE CO 786500 

♦ S) •) CC 786600 

”237 FORMAT (• FLD(*.I2,*> = • .30 1 2 .5 . JX . • (BODY*. 12.* FIXEC COO R C IN A T E CO 786700 

♦ S 1 • ) CC 786800 

23E FORMAT (11X.3DI2.S) ' C07869C0 

231 FORMAT (11X.* THAI*. 12.*) = * . 01 2 . 5 . 5X . • THAD(*.I2.*> ='.D12.E,/) CC787C00 

240 FORMAT (• FLJ(*.I2.*> = * . 30 1 2 . 5 . 3 X . • (BODY*. 12.* FIXED COORC IN A TE C C 78 7 1 0 0 

*S) • ) C0787200 

241 FORMAT' ( /// . 1 OX , • MODAL DATA FUR BODY * . 1 5 . 1 8A4 . / ) C07873C0 

24 2 FORMAT ( 10X. • THE FCLLC»ING BODIES HAVE BEEN REDEFINED TO BE FL E X I C C 78 7 40 0 

♦ EL E *.1015) CO 787500 

242 FORMAT (* •) CC 787600 

244 FORMAT ( 10X, * THE FULLC* I N G FLEXIBLE BODIES HAVE SIGNIFICANT MODE CC787700 

♦ COUPLING IN THEIR DEFORM. A T1CN EOUATT CNS * . 10 I 5 I CC787800 

246 FORMAT (17X.2D12.5) CC787900 

24 7 FCRMAT (• FCF< * . 12 . * . * . 12 . • . * . 12. • ) =*.JC12.5.* (bUDY*.I2.* F I XEC C C 788000 

♦ COORDINATES.) LOCATED AT F CF ( 1 , 1 . • , I 2 . *.) • I CC788100 

2 4 £ FORMAT (• FCK( * . 12 , * . * . 12 , • , • , 12. • ) =*.3D12.5.* (BCDY*.12.* F I XEC CO 788200 

♦ CCORCINATES) LCCATEC AT F CK ( 1 , • , I 2 . • I • ) . ' CC78e300 

249 FORMAT (• SCXC< • » 12 . • ) = O') CC78840C 

2 £ C FORMAT (• BODY *.12.* MCDE*.I3.* CROSS COUPLES In COORDINATE ECUA CO 788500 


♦ TICN ' .12.* COEFFICIENTS AT KF =*,I3) 
RETURN 
ENC 


CO 738600 
CO 788700 
CO 788800 


SUERCUTINE INTCR 


IMPLICIT KCAL*8( A-F ,0-Z . 1 1 
LOGICAL FG1 , FG2. FG3 . FG4. FG5. 

logical nstart. lr t ape 


INERF. RBLO. LEUU. L1NITI1) 


IN TEC E R 


RE AL *6 
< ANGC 


cceooooo 

C 0 800 ICO 
CC800200 

cceooooo 

CC81O4C0 
C080C50C 
CO 800600 
CC8CC700 
C C 800800 
CO 6C090C 


* 

A 1»CRK 


CT1 • 

CT 2 . 

C T 2 

t 

CT4 


CT 5 • 

FCUN 

. F CON 

coeoiooc 
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5CNCUN 


SCN t . # 

SCRDUV* 

SCF i( 
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5FKDUM 


SFK * 

SFP 

• SG 

co eo i ice 
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S I 


SIG • 

S I XDUR • 

sliV 


skcum ' 


SK •' 

SL 

. slk ’ 

'coeoi 200 

.* 

SRA 


SRC CUR. 

SRC . . 

SMV 

* 

SCK 


SP I DUM • 

SP I 

t SQF 

CCEC130C 

*; 

SCL 


SH • 

SSCN • 

S S IX 

* 

S V.A 


sve . 

svo 

• SV I 

CC £01400 
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•S*V M 


SVP, XN ,. N 

S>Vp. 

S XR 


S XT 


tof'q ’ •' 

SMAL 

. SEU 

cc eorsoc 

* 

SC 


5CG ♦ 

NFL XR • 

SFLX 

• 

5FXM 


N M C D S # 

SFCC 

. see 

coeoi6oc 

* 

I IN IT ( 

i 

» 

IZINIT( 

L ) 

t 

SD 





coeoi 7oc 


I 3 j) 


CNF 


( 2.10 


ET 1C (3,10) 


E T MC (3.10) 


cceoiaoo 

CO 8 01900 

coeo2coo 

CC 802 I OC 


/ 
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c 

c 

c 

c 

c 

c 


c 

c 


c 

c 


c 

c 


« FLQ 

( 2 .20 > 

• 

FLE 

( 2 .3 .20 ) . 

flh 

(3.3.20) 

• 




CCE02200 

* THAC3 

(20) 

• 

YVCO 

(2.2.11). 

RIMT 

(1 > 

• 

RZINITO ) 


C C 802300 












CC 602400 

CCMMCN 

/CHEK S/ 



N £ T AS T . 

LR T APE 





C C 802 500 












CC 802 600 
CC80270C 
CC E0280C 

CO MMCN 

/LOGI C/ 

F G l • F Q 

2* F G3 * i F(j5 • 

INERF , 

R SLU ( 10) 



CO 8 02900 












C Ce03000 
C C 8 03 100 

CO M MC N 
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A*ORK 

(200) . 







CC8C320C 

* CT1 



CT2 

• 

CT3 


• 

CT4 


* 

CC80330C 

* C TS 



FCQN 

(23) 

JCCN 

(10) 

• 

LCON 

( 22 ) 

• 

C080340C 

* MC 

(10) 


N6i 

« 

N3U0 


• 

NCTC 


• 

CO 80 350 0 

* nf£f; 



NFKC 


NF WC 


« 

NLCW 


t 

coeo36oe 

♦ s*v 



NNG 

• 

N MC A 


• 

NS VP 


f 

C0e03700 

* NSVC 



FCC N 

(11) . 

SO 


* 

SFR 

(33) 

• 

coe03800 

* sc- 



£ I 

( EE ) 

5 I G 


• 

SL 


f 

CO 8 0390 C 

* SLK 

( 2 3) 


SNA 

(10) . 

SCK 

>11) 

• 

SQF 

(11) 

• 

CC8040C0 

* SCL. 

(11) 


SNV 

• 

sr 


• 

S SCN 


• 

cc eo4 ioo 

* SE I > 



SVA 

• 

sv,s 


• 

SVC 


• 

CC 804200 

* S V I 



SVM 

f 

SVP 

(22) 

» 

SVQ 

( 33 ) 

• 

cc eo4300 

* S XM 

(2.10 


£ >T 

t 

TURO 

(9.7) 

• 

SMAL 


• 

coeo440o 

* SEU 



NTO 

• 

SC 

(33) 

• 

SCG 


• 

cc ec4boo 

* N FI. >B 



£FL X 

• 

SFXM 

(13) 

• 

NMCDS 


t 

CC8C4600 

* SFCC 



see 

( 10) 







cceo47oc 
cceo4soo 
co ec49co 

CCMMCN 

/ INTG 1 / 










ccecsooo 

* SCN COM 


• 

SCN 

(9) . 

SLRGUM 


• 

SCR 

(9) 

• 

CC 8.05 100 

* SFKCLM 


• 

SFK 

( 9 ) 

S I XDUM 


• 

SIX 

(9) 

• 

CC 805200 

* skdlm 


t 

SK 

( 9 ) 

SPIDUM 

* 

SPI 

(9) 

• 

CC 805300 

* SMCCtM 

• 

SNC 

< 9 l 







CO 805400 





l * 







CC 8055CO 
C0e05600 

COMMCN 

/REAL/ 










C0805700 

* CA 

(2.10) 


CAC 

(2.10 . 

Cl m 

(10) 


CG MC 

(3.11) 


CC80E80C 

* OCMC 

(2.11) 


ETC 

12.11) 

ET N 

(33) 


FOMC 

(3.11) 


C cec5900 

* GAM 

(2. fat.) 


H 

• 

HM 

(3,10) 


HM C 

(3.10) 


cceofaoco 

* FMQM 

( 10) 


PHI 

(2.11) 

PL M 

(10) 


OF 

(3,33) 


C C 806 10 0 

♦ OFC 

(2.33) 


OL 

(2.22) , 

QLC 

(3.22) 


RC MC 

(2,11) 


cce 06200 

* T 





THA 

(33) 


THAD 

(33 ) 


CC806J00 

* TRAC* 

( 10) 


T HA 

(10) 

X01C 

(3,3, fafa ) 


X l 

(3.3.10 


CC 8064C0 

* X IC 

(2.3.10) 


XMA s 

( 10 ) 

XMN 

(33,33) 


XMT 

(3.3.10 


C 0 806500 

* TLG 

( 23) 


FLA 

(3.20 , 

flb 

(3.20) 


flc 

(3.20 ) 


C0e06600 

* FLD 

(2.3,20 ) 


FL J 

( 2.3 .20 > . 

CAO 

(3.10) 


XIU 

(3.3.1C) 


CC 806700 

♦ FLIfiC 

(3.10) 


FLCRC 

(3.10 , 

FLAC 

(3,20) 


FL JC 

( 3.20 


CC8C6800 

* FLCM 

( 20 ) 


ZETA 

( 20 ) . 

FCF 

(3.40) 


FCK 

(3.3,40 


C C 8 06900 

* T I MEMO 











CC 807000 
CC 807 1 00 
C080720C 

COMMCN . 

/REAL 1/ 










C C 807 300 

* CECCM 

(1.3) 

• 

ce 

(2.10 

C3CDUMI l , 3 ) 

* 

CSC 

(3.10) 

• 

C0eC7400 

* . XMCCLM ( 1 . 1 . 9 ) 

t 

XMC 

(2.3.10). 

CUN ( 3 ) 

. . - - . , 

fa 

* 9- * • 1 »\ 

> t _ _ . 


.CC8C7500 












coeo7fcoo 

CCMMCN 

/ SA TELL / 

0 LMM Y ( 10CC ) 







CO 8C770C 












CC 807800 

EQUIVALENCE (ETMdliTHJOCd 1) 

• 

(XMN (1.1 

> . 

AN GD ( 1 

) > 


CC ec 7900 

*• 

( XMN ( 1.3), 

YMCC( 1.1,1) 

) , 

( XMN ( 1 .fa) . 

CNF ( 1 1 

1 ) ) 


cceoeooo 

* 

( XMN (1.8), 

ET IC( 1 , 1 ) ) 

• 

( XMN ( 1.10) 

• ETMCt 

1.1)) . 


coecsioo 
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no.*, OAnnn noon 


fF TURN 
ENC 


(FL6 ( X . 1 ) . FLCI 1*1)) 

( F LH ( 1.1 .1 ).FLJ(1. 1.1)1 
(FG1 .LINITII 1) 

(CBDUMI 1 .1 ) . RZ IN1T( 1 ) ) 
(SCNDLM, 1Z1NIT (11) 


. (FLE ( 1 , 1 .1 ) . F LD ( 1.1 .1) ). 
• 

. ( C A ( 1.1) .RINITI 1 ) ) . 

, (A»UKK( 1 ) , I INITl 1 > ) . 


CC £08200 
C0808300 

cceceooo 

C0e08500 
CCEC8600 
C08C8700 
CC808800 
CO 808900 
cceo9coo 


ccsooooo 

SEERCUT I NE TRNSI V(XMT.CF ,THA. JCUN ,PCCN . NBUD . RBLJ , IN ERF. XMCOUM ,*HC) COSOCIOC 
COMPETE INITIAL TRANSFCRMAT ION MATRICES C0900200 

8COY K TO COMPUTING FRAME COORDINATES C0900300 

C09004C0 

ENTER SLEPOUTINE WITH C090C500 

XMT = NOMINAL STATE TRANSFORMATION MATRICES EODY K TO 60CY JCC0900600 


OF = FREE CCCRDINATE VECTOR. EIGENVECTORS 
ThA = ROTATION ABCLT RESPECTIVE EIGENVECTORS 
RE TU F N FROM SUBROUTINE WITH 

XMC = INITIAL TRANSFORMATION MATRICES 6 CD Y K 


IMFLICIT REAL*e< A -H, C- Z . 1 ) 


LVDI V 

LXOY 

LANGLE 

1 ) 


LEGO IV 
LET A 
L SE TUP 


LTR AN 
L TO P GU 
LSI MO 


LOCICAL ROLO< ll.INERF. LEGU 
LOGICAL LRUNGE • LTRNSI 

* LTRANV , LRATC 

* LCFDOT . LDCT 

INTEOER J CO N ( 1 ).PCCN< 1) 

DIMENSION XMT (3.3. 1) . G F ( 3 . 1 ) . THA ( 

CIMENSICN XMODEM ( 1 . 1 .9 ) . XMC ( 3 . J. 1) 

C I MENS IEN X TMP( 3.3) .XTMIC3.3) , XTM2( 3 , 3 ) 

CIMENSICN G T 1 ( 3 ) . ZT 1 ( 4 ) .ZT2(4).ZT3(4>.ZT4(4),GT2<3) 

COMMON /LDEGUGZ LRUNGE . LTRNSI . LVDIV . LEGOIV . LTR AN 

* LTRANV . LR ATE . LXCY . LETA , LTOROU 

* LQFDOT , LOCT . LANGLE . LSETUP . LSIMG 

eceivalence (l trns i .lece ) 


CC900700 
C 0 90080 0 
C 0 900 900 

TC COMPUTING FRAC090100C 
CO 9 0 1 100 
C0901200 
C 0 9 0 1 300 
CO 90 1 400 
C09015C0 
CO 90 1 600 
C090 1700 
CC90I 800 
C0901 900 
C 09 02000 
CO 902 100 
CO 902200 
CO 902300 
C0902400 
C0902500 


CCMPc TE 


CO 902600 

TRANSFORMATION MATRICES WHICH TAKE VECTORS FR CM BODY JC C N ( C0902 700 


TU EODY K CUCRDINATES 

NOTE XMT TAKES VECTORS B CO Y K TC JCCN(K) IN NOMINAL STATE 
N = 1 

IF(.NUT. LEGE) GO TO 1001 
PRINT 2CC 
PRINT 2 3 C 
CO 1 9 K — 1 ,NBOD 
"• 'PR IN I 20 1 

PRINT 2C2. ( XMT( 1 , J.K) ,J=1 ,3) 

PRINT 2C3. K . ( XMT (2. J . K ) , J = 1 ,3 ) • 

-19 PRINT EC2. ( XMT( 3 . J.K ) ,J = 1 , 2 )> - . - 

I'OOT "CO l K = I.NdOD 

IF(EEGU) K1 = K-l 

XMT(I.J.K) - 3X3 TRANSFORMATION MATRIX BODY K TU JCONIK) 
XTMP(l.J) - 3X3 TRANSFORMATION MATRIX BODY JCCN(K) TO K 

CO 2 1=1,3 

CO 2 J = 1 . 3 


C0902800 
CC9C2900 
C0903000 
C 0 9 03 100 
C0903200 
CO 903300 
C09C3400 
C0903500 
CO 903600 
CO 903700 
C0903800 
C 09 03900 
CO 904000 
C09041 CO 
C0904200 
CO 904 3 00 
CO 904400 
C 0 904500 
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2 XTMP(I.J) = XMT(J.I.K) 

IFt.NOT. LEQU) GO TO 1CC-2 
PR IN T ZC4 
PR INT- 22 1 . K1 
PR IN T 205 .. K 
C 

C CCMPLT FREE COORDINATE LABEL 

' 1002 ’tF(K.EQ.l) GO TO 3 

M = » * 3 - PCGN(K-l) 

2 Ml = H ♦ l 
HZ = M * 2 

c 

C CHECK RIGID EOCY CP LINEAR CSCILLATCR 

IF(RELUIK) .AND.PCCMK) .NE.J ; GO TO 4 
C LINEAR CSCILLATGR CR THREE CCNSTRAINED AXES. JCON(K) TU K 

CO 5 1=1.3 

' CO 5 J= 1.3 

S XMC(I.J.N) = XTMP(I.J) 

IF(LEOU) PRINT 2C t, K 
GO TC 1 
4 CONTINUE 

C • EOCY K IS A RIGID BODY »RICH IS CONNECTED TO BODY JCUN(K) 

C BY EITHER a ONE. T»0 CR THREE AXIS G i MB AL 

C " * 

C PUT FREE VECTOR M IN COORDINATE FRAME I SUB N 

CALL VECTRN (QF( I ,M J . XTMF ,QT 1 ) 

IF(LEOU) PRINT 207. M 

C FORM RJTATION QUATERNION EOLATION FRAME I SUP N INTO I SUB I 

CALL QLATOPC QTI . TFA( M) ,2T 1 ) 

IF(LEOU) PRINT 2C8.M , ( ZT l < I > .1 =1 .4 ) 

C 

IF (PCCN ( K ) .NE. 2 I GC TO O 

■c SQDY K CONNECTED TC EOCY JCCMK) BY A ONE AXIS GIMEAL 

C- COCROINATE FRAME I SUB 1 IS dODY K FIXED FRAME 

C 

CALL TRANSOI IT 1 .XTMI ) 

IF(LEOU) PRINT 2CS 

C ■ FORM INITIAL TRANSFORMATION MATRIX JCJN(X) TC K 
CALL NATNULI XTMI , XTMP.XMCI 1 .1 ,K) .3) 

IF(LEJU) PRINT 21 C. K 
GO TC 1 
C 

C IF (PCCN (K ) .NE. 1 > CC TO 7 

•C- BODY K CCNNECTEO TC BODY JCCN(K) BY A TWO AXIS G I MB AL 


CO 9 046 00 

C0S04700 

C0904800 

C0904900 

C090S000 

C09051 00 

C090E200 

C0905300 

C0905400 

CO 90 550 0 

COS 0560 0 

C 0 905 70 0 

CO 905800 

CC 905900 

C C 5 060 0 0 

CO 5 06 1 00 

C0506200 

C0506300 

COS 064 0 0 

COSObSOO 

C0S06600 

C0S0670C 

C0906800 

C0906900 

C 0907000 

C0S07 100 

C0907200 

OCSC7300 

C0SC7400 

COS0750C 

CO SO 7 60 0 

C0SC7700 

COS0780C 

C0SC790C 

CC SC8COO 

cosoeioo 

cosoe2oc 

COS08300 
C0SC840C 
CO SO 8 500 
C0SC86O0 
C0SC870C 
COSC8800 
CC5C8900 


FREE VECTOR Ml GIVEN IN eOOY K COORDINATES. FORM POTATION 
CALL QUATOPt QF (1 . Ml ) .TEA (Ml ) ,ZT2) 

IF(LEQU) PRINT 211, Ml , Ml, (2T2II). 1 = 1.4) 

FORM RESLLTANT ROTATICN CLATERNIJN 
CALL CUTMUL ( Z T1 . ZT2 ,Z T4 ) 

IF(LECU) PRINT 212, ( Z T 4 ( I ) . I = I , 4 ) 

CAIL TRANSOI ZT4.XTMI ) 

IF(LEQU) PRINT 213 

FORM INITIAL TRANSFORMATION MATRIX JCUNIK) TO 1C 
CALL M ATMULC XTMI , XTMP ,XMC( 1 . 1 . K I ,3 ) 

-■ - 'IF (LECU ) PRINT 214, K j - i A ...... x 

. GG TC 1 • 

BODY K CCNNECTEO TC BOCY JCCMK) BY A THREE AXIS GIMBAL 
7 CALL VECROS tOF{ l ,H2 ) ,CT 1 ,012) 


OUATERN I CCS0900C 
CO 90 9 l 00 
C0S0920 0 
C0909300 
COS09400 
COS0950C 
CO 909600 
C0S09700 
C0909800 
CO S09900 
CCSI000C 
■-C0S10100 
C0S1020C 
C0S1 0300 
C0S1 0400 


" CALL VECNRMI QT2 ) 


COSl 0500 
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IFILEGU) PRINT 215. M2 C091060C 

THE CCMPCNENTS OF FREE VECTOR Ml FOR A THREE AXIS GIMBAE IN THE C0910700 
IN TERMED 1 A TE FRAME 1 SOB I ARC IDENTIAL TC ITS COMPONENTS CC MPuT C 0 9 1 0800 


*HEN SYSTEM IN NOMINAL STATE 
CALL GuATOPl QT2 . THAI M 1 > , 2T2 ) 

IF(LEOU) PRINT 216. V 1 . ( 2 T 2 ( I ) . I = 1 . 4 ) 
CALL OLA TOPI OF M ,M2) , T PA ( M2 I.ZTJ) 
IF(LEQO) PRINT 217. M2 .M2.( ZTJI 1 ) .1 = 1 .4 > 


CO SI 0900 
C091 1000 
C091 1 IOC 
C091 1200 
0091 1 300 


FCSM RCSLLTANT OLATERN ION BY SUCCESSIVE GOA TERN I ON MULTIPLICATION C0911400 


CALL GUTMUL 1 ZT 1 . ZT2 .Z T4 > C0911500 

IF(LEOO) PRINT 2 1 E CC91I600 

CALL GUTMUL ( Z T4 . 2 T 3 . Z T 1 ) C0911700 

IF(LEGU) PRINT 219. < Z T 1 ( I) . I = 1 , 4 ) C0911800 

CALL IWANSOI ZT1 ,XTM1 ) C0911900 

IF(LEGU) PRINT 22 C CC912C00 

FORM INITIAL TRANSFORM AT ICN MATRIX JCJNOC) TO X C091210C 

CALL MATMULl XTM1 . XTMP.XMCI 1 .1 , K ) .3) CC912200 

IFILEGU) PRINT 214. K CC912300 

1 CONTINUE CO 9 1 2400 

IFILEOU) PRINT 2 C 4 C 0 9 1 2500 

CO 9 1 260 0 

ALL CONTIGUOUS BODY TRANSFORMATION MATRICES COMPUTED C0912700 

>MC( 1 . J .K J - 3X2 TRANSFORMATION MATRIX BODY JCOMKI. T Li eOCY K ATC0912800 


IFl.NCT. LEGU) GO TO 100C 

PRINT 212 

CC 2 C K = 1 . N BOD 

PRINT 2 C 1 

PRINT 221. (XMCIl .J.K).J = 1 ,3) 

PRINT 222. K , I XMC <2 . J . K ) . J= I .3 J 
! PRINT 221, IXMCI3.J ,K ) , J = 1 ,3) 

PRINT 2 C 4 

COMPUTE TRANSFORMATION MATRICES. COMPUTING FRAME TU BODY K 

: IF I I NERF ) GO TC e 

IF(LEGU) PRINT 222 
IF(CECU) PRINT 201 
IC = 1 

GO TC 9 
■ IC = 0 

IFILEGU) PRINT 224 
IFILEGUJ PRINT 201 

: icei = ic ♦ i 

CO 1C KKK=ICB1 .NBCD 
K = NcCG - IKKK-ICD1) 

IFILEGU) PRINT 2C1 
KK = K 

JK = JCCN(KK) 

IF I JK .EG .IC) GO TC ) C 
CO II 1=1,3 
"CO 11 J = l , 3 

>TM1 I I , J ) = XMC ( I . J. K ) 

XTM2II.J) = XMC(I.J.JK) 
v -C A LL MATMUlI XTM I , XTM2 .XMCC I . 1 . K) . 3 ) 

’IFILEGU) PRINT 22 E . K.K.JK 
KK = JK 
GO TC 12 

continue 

IF(LEGJ) PRINT 204 


CO 91 2900 
CC91 3000 
C091 3100 
C091 3200 
CC 9 l 3300 
C091 340C 
CC 91 3500 
C091 3600 
C091 3700 
C091 3800 
CO 91 3900 
CC 914000 
C091 41 00 
C0914200 
C091 4300 
C09I 4400 
CC 91 4500 
C091 4600 
C0914700 
C091 4800 
CO 91 4900 
CC91 5000 
C0915100 
C 0 9 1 5200 
C091 5300 
C091540C 
CC 91 5500 
COS 1 5600 
CC915700 
C091 5800 
CO 91 5900 
C0916000 
CO 91 6 1 00 
CC916200 
C C 91 6300 
CO 91 64C0 
C0S1 6500 


n n 


C CET CCMFLT ING FRAME TO 8CCY 1 AND Id INERTIAL HEFcHENCE ' 

IF ( IC.EC.ll OJ TU 14 
CO IE 1=1.3 

CC 1 £ J=1 .3 
I E XMCI I . J . C) = 3 
XMCI 1 . 1 .C> = 1 
XMCI Z ,2 .C I = l 

xm c i 2 i 3 . c ) = i 

IFILEOU) PRINT 22 1 
CO TC It 
14 CO 17 1-1.3 

CO 17 J=1.3 

17 XMCIJ.I.CJ = XMCII.J.1) 

IF (L EQU ) PRINT 227 
CC 1 E 1 = 1 .3 

CO It j = l .3 

ie xmci i ,j . i) = o 

XMCt 1,1,11=1 
XMCI c .2 « 1 ) = 1 
XMC 12.J.1) =1 
IF (L ECO 1 PRINT 22 6 


CC91 6600 
C C 9 1 6 7 00 
CC91680C 
C0916900 
CC91 7000 
C.091 7100 
CO 9 1 7200 
C 09 1,7 300 
C091 7400 
C091 7500 
C091 7600 
C091 7700 
CC91 7800 
C091 7900 
C0916000 

co 9 1 a i oo 

C0916200 
C.C918300 
C 0 9 1 6 40 0 
C091 6E00 
CO 91 8600 


1 6. CC N T INUE 

•TRANSPOSE TO GET TR ANSF C F M A T I J N MATRICES 60CY K 
NHCD1 = NECD *■ 1 

CO IE RKK=1 , NbOC 1 
K=KKK - 1 

CALL T R N EPS ( XMC ( 1. 1 . K ) ) . 

IF < LEGO ) PRINT 229. K.K 
. 1 2 CC N T INUE 

IFI.NCT, -LEU L ) RE TORN 

PRINT 2 C A 

PRINT 222 

CO Z 1 . KKK=1 ■ NBCOl 

K- = KKK- 1 JV * 

FRINT 2 C 1 

PRINT 221. < XMC < 1 . J .K J , J= 1 , J 1 

PRINT 222. XL . ( XMC (2 . J. K ) ,J=1 , J ) . 


C09167C0 
CO 9 1 860 0 

TO COMPUTING FR A ME CC 91 6 90 0 
CC919000 
C09191C0 
• C0919200 
CC9193C0 
CO 91 9 40 0 
’ C 0 9 1 9 50 0 
C0919600- 
00919700 
0091 9800 
’ C C 9 1 9900 
CC92CC00 
' C 0 92 0 100 
CC920200 
' C09203C0 


2 1 

PR INT 

22 1 

. (XMCI3.J.K) ,J=1 ,3) 

CC9204C0 


PRINT 

2 C 4 



C C 92 0 500 

2 0 C 

FORMAT 

I • 

1 SU6RCLTINE TPNEIV ENTERED ’,//> 

C C 92 0600 

20 1 

FO PM AT 

< ■ 

• 1 


C0920700 

202 

FQ PM A T 

( 12X ,3015 

.£ ) 

C C 92 0 800 

20 3 

FOPM AT 

/ • 

X M T I ■ 

. 12. • ) = 1 ,2015.5) 

CO 920900 

20 4 

FOP MAT 

I 2 

l/> ) 


' C 0 92 1 000 

20 E 

FOPM AT 

( • 

XTMP 

= XM T I • , 12. • >*»T • 1 

C092 1100 

2 0 t 

FOPM AT 

( • 

XMCI • 

. 12. • 1 = XTMP • ) 

C092120C 

2 C 7 

FORMAT 

( • 

O Tl = 

XTMP * CF I • , I 2 . • 1 *1 

CO 92 1 300 

2C6 

FORMAT 

( • 

Z Tl = 

CLA TO FI CT1,THAI’,I2,’))’.8X,'= • , 40 15. 5) 

C0921400 

209 

FORMAT 

( • 

X TM1 

= transoiztii •) 

CO 92 1 500 

2 1 C' 

FORM AT 

I • 

. XMCI • 

. 12. • 1 = X^T M 1 * XTMP • 1 

CC921600 

2 11 

format 

I • 

Z T2 = 

CLA TOP I CF 1 • . 12. *1 , THAI • . 12. • 1 ) • , 5X , •= *.4015. 5)' 

CC 92 1 700 

2 1 2 

FORM AT 

I • 

ZT4 = 

ZT1 * ZT2 * . 1SX,’= • .4015.5) 

CO 92 1 800 

2 ) 3, 

.FORMAT 

I • 

X.TM 1 

= TR ANSC I ZT'4')'* M 

" "CO 9^2 1 90 0 

214 

FORMAT 

I • 

XMCI* 

.12.') = XTM 1 »' XTMP •) ' 

'00 92 2 000 

2 l.E 

FORMAT 

I • 

QT2 = 

NORMI CF I ■ . 12. • ) X QT 1 ) • ) 

C09221 00 

21 t 

FORMAT 

I • 

ZT2 = 

CUATOFl CT2 .THAI ■ , 12. • ) 1 • ,8X. ■= ',4015. 5) 

C0922200 

2 l 7 

FORMAT 

I • 

ZT3 = 

CL ATOP I CFI • .12. • ) , THAI ■ , 12 .*)»•. 5X. •= • . 40 15 .5 ) 

C092230C 

2 ie 

FORMAT 

( • 

Z T4 = 

ZTl * ZT2 • ) 

CC92240C 

2 1 9 

FORMAT 

( • 

Z Tl = 

ZT4 * Z T 3 • , l 5X , * = ’,4015.5) 

CC 92 2500 
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; -22 C FORMAT ( • 
.1,22 1 FORMAT ( 12X 
-222 FORMAT (' 
222 FORMAT ( • 
224 FORMAT ( • 

22 £ FORMAT ( ■ 

2 2£ FORMAT ( • 
227 FORMAT ( • 

, 22 £ FORMAT (• 
V22 9 FORMAT (• 
-y23C" FORMA T ( 10X 
*Y "jCCM K ) < 

22 1 .FORMAT < 10X 
2 232. FORMAT ( 10X 
. *.CO 7 X ' ) 

232 FORMAT 1 10X 
. * NG FRAME • 

RETURN 
.ENC 


XTM1 = TR AN SC ( Z T 1 ) . • ) 

. 3D15.E > 

XMC( • . 12. • ) = • .2015.5) 

COMPUTING FRAME FIXED I 
COMPUTING FRAME FIXED I 
XMC< • . 12. • ) = XMC< • . 12. 
XMC ( C ) = 1 • ) 

XMC( 0 ) = XMC ( 1 >**T • > 

XMC ( 11=1 • ) 

XMCI • . 12. < ) = XMC ( • . 12. 
.•TRANSFORMATION MATRI 
.// > 

. • HINGE POINT < . I2./I 
, • TRANSFORMATION' MATRI 


, • TRANSFORMATION MATRICES. TIME ZERO BODY K 

, /) 


C0922600 
C0922700 
C0922800 
CCS22900 
C C *523000 
CC923100 
CO 923200 
CO 92 3300 
C 0 9234 00 
C O 923500 

STATE BOCY K TC EODC0923600 
CC 92 3 700 
C0923B00 

CES. TIME ZERO BODY J COM K 1 TC eCC923900 
- ' C C 92 4 000 

TC CCMPC T I CC924 IOC 
■ CC 92 4200 
C0924300 
C0924400 


N c JOY 1 • ) 

NERTI ALLY • ) 

• > * XMCt • , 12 . • > 


• )*»T ■ ) 

CES. NOMINAL 


SUBROUTINE VCI V 

USED TO TRANSFORM ALL VECTORS AND DYADS TO COMPUTING FRAME 

cefines free anc lockec vectors not inputed 

SETS UP DU LOOP SETS FCR T R AN VD 


Cl COOOOO 
C1C00100 
C 1CC0200 
Cl C0030C 
C 1 C00400 
C 1 C00500 
Cl C00600 


OOP! 

C 

c 

C , 

c 


IMFLICIT 

RCAL*ai A-F.O-Z 

.11 







CIC00700 

logical 


FG1 , 

FG2. FG3. 

FG 4 . F G 

5. INERF 

t 

R3L0. LECU. 

LIMT(I) 


C 1 COC800 

logical 



LRLNGE 

. LTRNSI 

. LVUIV 


. LEOU I V 

. LTRAN , • 


Cl C00900 

* 



LTfiANV 

. LRATE 

. LXDY 


. LETA 

. L TOR CU , 


Cl C01 000 

V • 



LCFOOT 

. LOCT 

. LANGLE 

, lsetup 

• LSI MQ 


C1C01 100 












C ICO 1 200 
Cl C 0 1 3 0 0 

INTE C£k 











C1C01400 

* AUtCRK 


CT1 

. CT 2 

. C T 3 

. CT4 


CT 5 

FCCN 

. PCCN 


C 1 C01500 

* SCNCLM 


SCN 

. SCRDUM 

. SCR 

. SFKDUM 


SFK . 

SFk 

* SG 


C 1 CC1600 

* SI 


SIG 

.’ SIXCUM 

. six 

. SNDUM 


SK , 

su 

• 5LK 

• 

C1C01700 

** S*A 


SMCDUM. SMC 

. SMV 

. SON 


SP IDUM, 

spi 

• SQF 

* 

C 1 C01 800 

* SGL 


Sk 

. SSCN 

. SS IX 

. SVA 


SVB . 

SVD 

* SV I 

t 

C 1001900 

* S\iM 


SVP 

o 

> 

V) 

, SXM 

. SXT 


TORO . 

SMAL 

* stu 

* 

Cl COZOQQ 

> SC 


SCG 

• NFL Xb 

. SFLX 

. SFXM 


NMOCS . 

SF CC 

* see 

• 

CIO C2 IOC 

* I IN IT ( 

i ) 

. IZlNIT(l) 

, SO 






C 1 002200 












C I 002300 












C 1.002400 

i - - 




/ «. 

"VTX n 


. 7 , , •. i •• 



* ’ 

,C 1,002500 

kE *L*ti . 


, 









c 1 002'ecc 

* A N G C 

i 

33) 

. CNF 

<3. 10) 

... STIC 

(3 

.10) . 

E.T*C 

(3.10) 

• 

Cl C02700 

sVfi LQ 

i 

3.20) 

. FLE 

( 3.3 .20 ) 

. FLH . , 

V 

.3.20) .. 

t” i i J Slr\ 

M t - 

, A * . 


Cl 002800 

♦ ThACD 

i 

iJ> 

. YMCD 

(2.2.11) 

. RIMT 

( 1 

) . 

RZI N IT ( I ) 


Cl C 02900 


CCMMCN /LDEBUG/ LRLNGE 
. . L TR AN V 


L TR NS I 
LRATE 


LVDI V 
L XU Y 


LEOU I V 
LETA 


ltran 
L TOR QU 


Cl C03000 
C 1 C03 100 
C1C03200 
C1C03300 
Cl C03400 
Cl 003500 
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c 

c 

c 

c 


c 

c 


c 

c 


c 

c 


* 




LQFDOT 

. L DC T 


. LANGLE . LSETJP , LSIMQ 


C 1 CC3600 














C 1 C 03700 
Cl C03800 


COMMCN 

/LOGIC/ 

FG 1 « FG2t FG2* FG4 * FGi> 

I NE FF . 

RBLLM 10) 


C 1C03900 














Cl C04000 
C1C0410C 


CCMMCN 

/ INTG/ 


AteORK 

( 200 ) 








C l C 04 200 

* 

CT1 



C 7 2 



CT 3 


• 

CT 4 


• 

C 1 C04300 

* 

C T5 



F CON 

( 22 ) 


J CC N 

( 10 ) 

* 

LCCN 

(22 ) 

* 

C 1 C0440C 


MC 

( 1C ) 


ISEI 



N3UD 


• 

nctc 


• 

C 1 C04500 


N PER 



f^FKC 



Nr RC 


• 

NLUR 


• 

Cl C04600 


NMV 



NMC 



NMOA 


• 

NS VP 



C 1 C0470C 


NSVC 



FC ON 

(11) 


50 


t 

SFR 

( 22 ) 

• 

C 1 C04800 


SG 



£ I 

( 25 ) 


5 IG 


• 

SL 



C 1 C04900 


SLK 

( 23) 


SNA 

( 10) 


SO K 

( 11 ) 

t 

S OF 

(11) 

• 

C 1 005000 


SCL 

< 11 ) 


S MV 



SR 


t 

SSCN 


• 

C 1 C05100 


S S I X 



SVA 



SVd 


• 

SVD 


• 

C 1C05200 


SV I 



SVM 



SVP 

(22 ) 

• 

svo 

( 22 ) 

• 

C 1 C05300 


SXM 

(3.10) 


£XT 



TUKCJ 

(97) 

t 

SMAL 


• ’ 

C 1 C05400 


SEU 



NTQ 



SC 

( 33) 

• 

SC G 


• 

Cl 005500 


NFL 



£FL X 



SFXM 

( 10 ) 

• 

NMCDS 



C 1 C05600 


SFCC 



£ CC 

( 10 ) 








Cl C05700 
Cl C 05800 
Cl CC5900 

CCMMCf* 

/ IN !"GZ/ 











C 1 C06000 

4 

SCNC CM 

• 

SCN 

(9) 

• 

SCRDUM 

* 

SCR 

( 9 ) 

• 

C 1 006 1 00 

♦ 

sfkclm 

• 

SFK 

(9) 

• 

S I XOUM 

• 

S I x 

(9) 

• 

C l 006200 

♦ 

SKOLN 


• 

SK 

( 9 ) 

• 

5P IDUM 


• 

SPI 

( 9 ) 

• 

C 1 C06300 

4 

SMCCL.M 

• 

smc 

( 9) 








C 1 CC6400 














Cl C065C0 
C 1 C06600 

CCMWCN 

/FE AL / 











C 1 C06700 


CA 

(3.10) 


CAC 

(3.10) 

• 

CLM 

( 10) 


CC M C 

(3.11) 


c i coeeoo 


DCMC 

(3.11) 


ETC 

(2,11) 

• 

ETM 

( 33) 


F 0 ML 

(2,11) 


Cl C 06900 


GAM 

(3.66) 


H 


• 

HM 

(3.10) 


HM C 

(3.10) 


Cl C0700C 


HMQK 

( 10) 


PFI 

(2.11) 

• 

PL M 

(10) 


OF 

(3.22) 


C 1 C07100 


OFC 

( 3 . 33 ) 


CL 

(3.22) 

i 

OLC 

(3.22) 


R C MC 

(3,11) 


C 1 C07200 


T 






THA 

( 33) 


THAD 

(33) 


Cl CO73C0 


TFACW 

( 10) 


THAW 

(1C) 

* 

XOIC 

(3.3, 6o ) 


XI 

(3.3.10 


C 1 C07400 


X tc 

(2.3. 10) 


XMAS 

(10) 

• 

XMN 

(33.33) 


XMT 

(3.3.10) 


Cl C C 750 0 


TLG 

( 23) 


FLA 

(2.20) 

• 

FLB 

(3.20) 


FL C 

(3.20) 


C l CC7600 


FLD 

(3,3,20) 


FL J 

(2.3 .20 ) 

• 

C AO 

(3.10 


XIO 

(3.3.10 


Cl 0077C0 


FLlfiC 

(2.10) 


FLCRC 

( 3. 1 C ) 

• 

FLAC 

(3.20) 


FL CC 

(3,20 


C 1 C07800 

♦ 

FLO A 

(20 ) 


ZETA 

( 20 > 

• 

FCF 

(3,3 .40 ) 


FC K 

(3.40 


Cl CC7900 

* 

T IMENO 












Cl C08000 
C 1 C08100 
C 1 C08200 

CCMMCN 

/FEALZ/ 











C 1 C08300 

4 

cecLM 

(1.3) 

• 

CE 

(2.10) 

• 

CBCDUM( 1 ,3 ) 

• 

CBC 

(3,10) 

* 

C 1 C0840C 

4 

XMCCLM (1.1.9) 

* 

xvc 

(2.3.10) 

■ 

C6M J ) 






C 1 C08500 


C 

c 

EQLI VALENCE (ETM( 1 ) . THAOCl 1 ) ) 

* (XMN( 1 .3) . YMCC( 1 .1 .1 ) ) 

( XMN ( 1 tti) t ET IC( ltl ) ) 

* (FLB( 1.1). FLQ( 1.1)) 

* ( FLH ( 1.1.1 ),FLJ(1. 1.1)) 

* (FG1 .LINITl 1 ) ) 

* ICBDUKl 1 .1 ) .RZIMTl 1 ) ) 

* (SCNOlK.IZIMT(l)) 


. ( XMN (1.1). ANGD( 1 ) ) , 

. ( XMN ( 1 .b),. CNF ( 1 , 1) ) . ^ , 

. 1 XMN ( 1 .10) .E T,MC ( l.^l-)' 

. (FLE 11.1.1) .FLO ( 1.1.1) ) . 
. 

. <CA< l . 1 ) . n INI T ( 1 ) ) , 

, i akuhm D.iiNinin , 


; C li C C6 600 
Cl C06700 
C 1 CO08OO 
^008900 
^01 C09000 
C 1 CO 9 l 00 
C 1 C09200 
Cl C09300 
C 1 C09400 
C 1 C09S0C 


V 
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c 

LOGICAL CTA1N 

1NTECEH S£T( 16}.S(1E) . S£ < 1 b > 

IN TECER' STM 10 li ST2( 10).£T3(I0>.ST41 10) .5 Fx*N 
KE)L»c TEM13), TEMK3.2). TeM2(3.3). TEM3I3.3) 

eolivalence ilvdiv.leolj 
c 
c 
c 

IF (LECU )FR INT 200 
C 

IF ( I Nc^F ) GO TO 1 
IC = 1 

IF (LEOU )PKINT 201 
GO TC 7 
1 1C = 0 

IF (LEOU )PR INT 202 
7 CONTINUE 
C 

C INCLLOE FLEXIBILITY FFFECTS 

IF (NFLXB ,EU. C> GO TO 7 E 
CALL LNPACISET.NSET, SFLX ) 

IF(LEOU) PRINT 231, SFLX .( SET! I ) ,1 =1 .N3ET) 

C SAVE LNCfcFORMEO CM VFCTCP AND INERTIA TENSOR DATA 

MN = C 

CO 7 t NN=1.NSET 
N = SET INSET )TNN1 
IF (LEOU 1 PRINT 257. N 
CO 77 1=1,3 

CAC( I.NJ = CA(l.N) 

CO 7? J=1.J 

77 > 1 C ( I , J , N 1 = XI< I ,J.N) 

IF ( . NG T .LEOU ) GO TO 10C1 
PRINT 232. N.N 

PRINT 234, N«N ■’ 

PRINT 233 

1001 CONTINUE 
SFXMN = SFXM(N) 

CC 7E M=l, SFXMN 
MN = KN+l 

CALL VCCTRNIFLAIl ,kn),XMC(1.1..J),FLAC(1,MM) 

IF ( . N JT .LEQU ) GO TC 10C2 
PRINT 2EE, N,MN ) 

PRINT 2 4 E , MN , N . MN , ( FL AC < I ,*N) . 1 =1 . 3 > 

PRINT 233 

1002 CONTINUE 

C LSE TEMPORARY LOCATIONS SO THAT 

C ECU IVALENCE MAY EE LSED TO SAVE STORAGE 

CC 7S 1=1,3 
CO 7S J= I , 3 

TEMl(I.J) = FLDC1.J.KN) 

TEM2II.J) = FLC(J.I.MN) 

7 S TE M 3 ( l ,J) = FLJ(I.J.MN) 

^CALL L'YACuI TEM 1 . TEN2 ,FLE C 1 , l ,MN) 1 
" ALL GY ACDl'TEM i ?+ E?3 iFLN < 1 .1 ,'MN) ) 

IF ( .NO T .LLUU ) GO TC 10C3 

PRINT 244, < FLE ( 1 , I . MN 1 , I =1 .3) 

PR INT 242, MN ,MN.MN , ( FLET 2, I ,MN) ,1 = 1 ,3) 

FRINT 24 4, I FLE ( 3 . I ,MN ) , 1 = 1 ,3 ) 

PRINT 233 


C 1 C09E00 
C 1 COS 700 
C 1 CC9B00 
Cl 009900 
C 1 Cl 0000 
C 1 Cl 0100 
C 1 Cl 0200 
C 1 Cl 0300 
C l CI040C 
C 1 Cl 0500 
C 1 Cl 0600 
C 1 Cl 0700 
C 1 01 0800 
C 1 Cl 0900 
Cl 01 1000 
C 1 01 1 I oc 
C 1 Cl 1 200 
C 1 Cl 1 300 
C 101 1 400 
C1C1 1500 
C 1 01 1 600 
Cl Cl 1 700 
C 1 01 1800 
C 1 Cl 1 900 
C I Cl 2000 
C 1 01 2 1 00 
C 1 01 2200 
Ci Cl 2 30 C 
C 1 Cl 2400 
C 1 Cl 2500 
C 1 Cl 2 60 C 
C 1 Cl 2700 
Cl C 1 2800 
C I CI 2900 
C 1 Cl 3000 
C 1 Cl 3100 
C 101 3200 
C 1 Cl 3300 
C 1 Cl 34 OC 
C 1 Cl 3500 
C 1 Cl 3600 
C 1 01 3700 
C 1 C 1 3800 
C 1 Cl 3900 
C1C14000 
C 1 Cl 4100 
C 1 C 1 4200 
C1C14300 
C I 014400 
C 1 Cl 4500 
C 1 C1460C 
CI C I 4 700 
C 1 Cl 4800 
C 101 4900 
Cl 01 5000 
C 1 Cl 51 00 
C 1015200 
C 1 Cl S300 
C 1015400 
C 1 Cl 5500 
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PRINT 24 4. (FLK 1 . I ,M,N) ,1=1 ,J> 

C 1 C15600 


PR 1NT 242.MN , NN.MN , ( FLF { 2 . I ,M,\1 ) .1 = 1 ,3) 

C 1 Cl 5700 


PRINT 244. IFLHC3. I .MN) ,1 = 1 .J) 

C 1 Cl 5800 


PR INI <z32 

C 1 01 5900 

ICC 2 

CONT lNU E 

C 1 Cl 6000 

c 


C 1 Cl 61 00 

c 

cc fpite c vector in body n fixed frame 

C l Cl 6200 


call VECROSC CAUC 1 ,N) .FLA < l ,NN ) , TEM ) 

C 1 Cl 6300 


CALL VECSUdl FLBI 1 .NN) , TEN ,TEM) 

Cl Cl 6400 


CALL SCLVI XMASIN ) .TEM .TEN ) 

Cl Cl 6500 


CALL V EC ADD l FLC ( 1 »NN ) .TEN ,FLJ( 1 , MN) ) 

C 1 Cl 6600 


CALL VLCTRNIFLOC 1 ,NN ) .XNCC 1 .1 .N) .FLGCC 1 ,MN) ) 

C 1 Cl 67C0 


IF ( . NOT .LEQU ) GO TC 1CC4 

C 1 Cl 6800 


PRINT 2 4 5, MN.MN.K.MN.N.NN. (FLQ( I.MN) ,1=1,3) 

C 1 Cl £>900 


PRINT 222 

C I.C1 7000 


PRINT 245. MN.N.MN.IFLQC (1 >NN) .1=1 ,3) 

CIC17100 


PRINT 232 

C l Cl 7200 

1 C C 4 

CCNT inle 

C1C17300 


CALL SCLVI THAI NFF.fi +MN ) ,FL AC 1 .MN) . TEM) 

C IC1 7400 


CALL VbCADDC CAC 1 • N ) • TE* • CA< 1 . iM ) ) 

C l Cl 7500 


CALL SCLC ( THAI NFE fi + MN ) ,F LE ( 1 , 1 , MN> . TEM 1 ) 

C 1 Cl 7600 


CALL OYACDCXIl 1,1 .M .TEN 1 , X I ( 1 . 1 ,N) ) 

C 1 Cl 7700 


IF ( • NCT .LEQU ) GO TC 10C6 

C l Cl 7800 


KFCW = NFcR+MN 

C 1 Cl 7900 


PRINT 24 6. N.N.NFCN.MN 

C 1 C 1 8000 


PRINT 247. N.N.NFCN.MN 

C 1 Cl 8 100 


PRINT 222 

C 1 C18200 

ioce 

continue 

C I Cl 8300 

7e 

cont I NOE 

C 1 C 1 8400 


IF { . N C T .LEOU ) GO TO 1CC7 

C 1 C 1 0500 


PRINT 2E5. N 

C 1018600 


PRINT 252. N ,( CAI I .N) . 1 = 1 ,2 ) 

Cl Cl 8700 


PRINT 222 

C 1 01880C 


PRINT 254, ( X I < 1 , I ,N ) . 1= 1 .3 > f 

C 1018900 


PRINT 255. N , ( XI ( 2. I .N ) , 1 = 1 .3) 

Cl Cl 9000 


PRINT 254. (XI<2.I.NJ.I=l.3i 

C 1 019 100 


PRINT 233 

Cl C1920C 

1 ocv 

CONTINUE 

Cl Cl 9300 

76 

continue 

C 1 Cl 9400 

75 

CCNT INUE 

C l C19500 

C 


C 1 Cl 9600 

c 


C 1 01 9700 

c 

CENTER OF MASS VECTORS 

C l Cl 9800 


IF (LEQU »Ffi INT 204 

C 1 Cl 99C0 


DO 2 J=l.N30D 

C 1 C20C00 

2 

CALL VECTRN (C A( 1 , J) , XNC < 1 . 1 . J ) , CACC i . J )) 

C 1C20100 


IFC.NCT. LEO L ) GO TO 1C2C 

C IC20200 


CO 8 J=1,N3UD 

Cl C20300 

e 

PRINT 2C2. J . J.J. (CACC I ,3) , 1 = 1 .3) 

C 1 C2040C 

c 


C l C205C0 

c 

INERTIA TENSORS , ■ ■ 

C1C20600 


PRINT 2C5 

C 1 C207CC 

132C 

CALL ONP AC (SET.NSET.SR) 

C 1 C20800 


CO 45 J = 1,NSET c <_ I I r :12-T. T32 . LL )M1AT0, 

k = sen j) 

C10209C0 
! 0/1 „ ) -1' 

C 1 C2 1 000 


CALL TENIRN 1X1 ( I .1 .K) ,XNCI 1 . 1 , K > ,XIC( l .1 .K) ) 

C 1 C21 1 00 


IFI.NCT. LEOU) GO TO 1CCC 

C 1021200 


CO 4<» J=1 |N£ET 

Cl 02 1300 


PRINT 232 

C 1 C2 1 400 


k=set< J ) 

C 1 C21 50C 
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u u 


45 


c 


100C 

c 

c 

c 

c 


5 l 


ac 

sc 

5024 

47 

a l 

4 t 


c 


4 


C 

c 


FRIN1 2Ct. < X 1C ( 1 .L .K) .L=l • 2 > 

PRINT 2 C 7 * K .K .K, K . ( XIC ( 2 .L .K> .u=l .3) 

FRIM 2C£. {XICC2.L .Kl ,L = l .5) 

CONTINUE 

GST ELEMENTS OF SVAJ THAI IS. SVD MINUS 2EKC CA VECTORS 
IF 8CCY FLExIdLE eCTH CM VECTOR AND INERTIA TENSOR MUST BE 
TRANSFORMED EVERY STEF 
CALL UNFACISET .NSET .SVD ) 

CALL UNFACIST1.NSI.SFLX) 

IF (LEGO )FR INT 2Cd. SVC . ( iET I I ) . 1 = 1 .NSET ) 

ns = a 

CO El 1=1.18 
5(1) = C 

IF (N SET .EO. 0 ) GO TC 5024 
DO 5 C J = 1 ,NSE T 
K = SET ( J ) 

IF (C T A I N (K ,ST I ,NS 1 ) ) GC TO EO 

IF (CACI 1 .K) .EQ.O. AND.CAC <2. K) . £0. 0 . AND . CAC I 3 , K ) .EQ.O) GC TO 5C 

CONTINUE 

NS = N S ♦ 1 

SINS) = K 

CONT I NOS 

CCNT INUE 

CALL CUMFACI S .NS , SVA ) 

IF (LECU) PRINT 241, SVA ,< SI I ) .1 = 1 .NS) 

CO 47 1=1.13 

St I ) = C 

CALL UNRACISS.NS. SVD) 

CALL LNFAC(SET.NSET.SR) 

K = C ' 

CO 4 t J = 1 . N ao D 

IF ( .NOT . (CTAINI j , SET. NSET ) . AND.CTA INI J. SS. NS ) ) ) GO TO 46 

CONTINUE 

K = K A 1 

SIX) = J 

CCNT INUE 

CALL CCMFACI S.K.SVI) 

IFILEGU 1FRINT 205. S V I , ( S ( 1 ) . I = l .K ) 

CU ON SVI ELEMENTS IN TH AN VC TO GET XIC 

t-INGE VECTORS 
IF (LEOU )PRINT 2 1 C 
CO 4 J= 1 . 1 8 
S(J) = C 

call UNP ACISET .NSET. SVC) 

K = C 

CO 5 J= 1 ■ NdOD 
JJ = JCCN(J) 

CALL VECTRN IC8I 1 , J) . XMC ( 1 . 1 . J J) .CdC( 1 . J ) ) 

IF (LEOU)FRINT 211. J.JJ.„, (CBCI I.J) .1=1 .J) 

IF (C EC ( I , J) . EO .0. AND.COC (2 . J) .EO. 0 . AND .CiiCI 3, J ) .EC. 0) GO TO 5 
IF ( .NO T .CTAI N< J J , SET ,NSE T ) ) GU TO 5 
K = k A l 
SI K) = J 
CC NT INUE 

caii) alcng with chcii) nlst as computed at each integration step 

POT I IN SV3 
K = KH 


CIC21600 
C 1 021700 
C 1 C2 1 800 
C 1 C21900 
C I C22000 
C 1 022100 
C 1 022200 
C 1 C22300 
C 1 C22400 
C 1 C2250C 
C 1 C22600 
C 1 C22700 
C 1 C22800 
C 1 022900 
C 1 C 2 309 0 
Cl C23100 
C 1C232C0 
C 1 C2330C 
C 1 C 2 3 4 00 
Cl C23500 
Cl C23600 
C l C2370C 
C 1 C23800 
C l C23900 
C 1 C24000 
C 1 C24 IOC 
C 1 C24200 
C 1 C24300 
C 1 C24400 
C I C24500 
C l C2460C 
C 1 C24700 
C I C2480C 
C l 024900 
C 1 025000 
C 1 025 1 00 
C 1 025200 
Cl C25300 
Cl D2S40C 
C 1 02550C 
.Cl C25600 
C l C25700 
C I C25800 
C 1 C25900 
C 1 026000 
0 1026 100 
C 1 026200 
C 1 C26300 
C 1 C26400 
C 1 C26500 
C 1 C26600 
Cl C2(>7 00 
C 1 C268O0 
Cl C26900 
Cl C2 7 0 0.0 
C 1027100 
C 1C272CC 
. C 1 C 2 7 300 
Cl C274CC 
C 1 C275O0 
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9 n . ....... .on 


£ ( K > = 1 

e CALL CC M F AC ( S.K.3VE) 

IF ILEU'U 1PA1NT 212, SVB.(£< 1 1.1=1 ,K) 

' DC CO SVb ELEMENTS IN TCANVD 

NOTE CEC(I.O) IS COMPOSITE CENTER OF MASS, MUST 3E CALCULATf C 

FREE ASC L OCKEO CDOPCIOATE VECTORS 
IF (LEJO 1FR IN T 213 
M = l 
L = 1 

CO 9 K = 1 , Nfcj 00 
IF (K .£0 . 1 ) UO TO 1 c 
• M = N 3-PCGN ( K — 1 ) 

L = L+PCCNIk-1) 

1C M = HI 

• >2 = m+2 

L l = L + 1 
L 2 = LP2 

1GCTC - ICON (K ) P 1 
CO TC ( 1 1 . 1 2 . 1 3 . 1 4 ) , 1 GOTO 

thfce degrees of freeocm 

11 CALL VCCTRN (OF ( 1 ,M> ,XMC < 1 . 1 .FCONI M ) ) , JFC < 1 .Ml 1 
CALL VECTRN (OF ( I ,M2 * , XMC( 1 , 1 iFCOM M2) ) ,OFC ( 1 ,M2 I ) 

IF (LECL JFRIN T 214, H.FCCMWJ.M 

IF (LEUO 1FKINT 214, M2 . F C C N ( M 2 1 . M2 
IF (FCCNIM1 l.LT.Ol GC TC 15 

CALL VcCROS (OF( 1 ,M2 ) .OF ( 1 . M> , OF ( 1 ,M1 » ) 

IF (LEQU 1PK IN T 236 . M1.M2.M 

CALL VECTRN (OF ( 1 .Ml > , XMC( 1 . 1 . FCOM Ml ) ) , OF C ( 1 ,M 1 ) ) 

IF (L E JU 1RR INT 214. Ml ,FCCN ( ► I 1 .Ml 

• GO T C * 

IE CALL VECRUS (CFC( 1 ,M2) ,OFC( 1 ,M 1 . CSFC ( I . M l ) ) 

CALL VECNRrt (OFC(l.Mll) 

CO 4 E 1 = 1.3 
4 5 CF ( I .Ml ) = 0 

IF (L ECU 1PR INT 216. MI, M2, M 
GO T C 9 

TwC DEGREES OF FREEOCM 

12 CALL VElTRN (OF ( 1 ,M) , XML ( 1 • 1 .FCOM Ml > , OFC( 1 , Ml ) 

CALL V-CTRN (UF ( l .Ml ) , XMC( 1 .1 .FCOMKI ) ) .MFC ( 1 .Ml ) ) 

IF (LEULI )FR INT 214. M, FCCMH. M 

IF (L ECU JFR INT 214, Ml, FCCMM1), Ml 
IF (L CON (L).lT.O) GL TO 16 

CALL VcCROS (OF ( 1 ,M) ,QF ( 1 .Ml 1 , OL ( 1 ,L) ) 

IF (LEQU )FR IN T 237 . L.M.Ml 

CALL VcCTRN (GL( 1 .L ) . XMC ( 1 . 1 .LCJN(L) > >ULC( 1 ,L> » 

IF (LEOU >FR INT 217. L. LCtML), L 

GO TC 9 ! ' 


C 1 C2760C 
Cl C27700 
C 1 C278C0 
Cl C27900 
C 1 028000 
C 1 C28 100 
C 1 C282C0 
Cl C28300 
Cl C2840C 
C 1 C28EOO 
Cl C28600 
C 1 C287C0 
. C I C28800 
C 1 C28900 
C 1 C29000 
C IC2910C 
C I C2920C 
Cl C29300 
C 1 C29400 
Cl C29S00 
C 1 C2960C 
C 1 C29700 
C 1 C2980C 
Cl C2990C 
Cl C3000C 
C IC301CC 
C 1 C30200 
C 1 C30300 
Cl C304CC 
Cl C30S0C 
C 1 C3060C 
Cl C3070C 
Cl C30800 
C 1 C3C90C 
Cl C31 000 
C 1C31 100 
C 1 C 3 1 200 
Cl C 31300 
CIC31400 
C 1 C31 500 
Cl C3160C 
C 1 C3 1 700 
C1C31800 
Cl C31 90C 
Cl C320C0 
C 1 C32 ICO 
C 1 C32200 
C 1 C32300 
C 1 032400 
C 1 C32S0C 
C l C32 600 


16 CALL VECRUS (OFC ( 1 ,M » ,CFC( 1 .Ml ) , OLC ( 1 .L 1 ) 

CALL VcCNKM (ULL(l.L)l 
CO 2? 1=1.3 

2<r CL(I.L) = 0 

IF (LEQU 1PRINT 235 . L.M.Ml 
CO Tl 9 

• CNE DECREE OF FREEDOM 

12 CALL VECTRN ( QF ( 1 , M 1 , XMC < 1 . 1 .FCUN( M ) ) . QFC( l . Ml 1 


C 1 C32 70C 
C 1 0328C0 
Cl C32900 

; <.«. F-'cvbj 3000 

C 1 C331 OC 
C 1 C33200 
C 1 033300 
C1C3340G 
C I C3350C 


A-62 


n n n non An 


CALL VECTRN (QL(1 , L 1 • X X C ( 1 « 1 iLCON(l) 1 , ULC ( 1 »L ) ) 

IF (LEUU1PKINT 214. K.FCCMK1.M 
IF (LECU 1FHINT 217. L.LCCMLI.L 
IF(HELlHK)) GO TO 17 

CALL VECRGS < OF ( 1 . X) . GL ( 1 . L ) .OL ( 1 . L 1 ) » 

IFILEGUJFRINT 238. L 1 . X . L 

CALL VEC1RN (QL( 1 ,L 1 1 . XMC( 1 , 1 ,LCUN(H 1 1 .GLC ( 1 .LI 1 1 
IFILEGU 1FRINT 217. Ll.LCCMLU.LI 
CO TC 9 

17 CALL TRNSP5 (XMTU.l.KI) 

CALL VECTRN ( OF ( 1 .XI . XMT ( 1 . 1 .< ) , TEM ) 

CALL TR N SP S (XMT(l.l.Kl) 

CALL VECROS (TEX . CL ( 1 «L) . Q L ( l.Ll > I 
1F(LECU IFfilNT 239. Ll.K.X.L 

CALL VECTRN ( GL < 1 .L 1 1 . XMC ( 1 . 1 , LCuN ( L 1 l 1 . GLC ( l . L 1 1 l 
IF (L EGu 1FR l N T 217, L 1 .LCC N < L 1 I . L 1 
GO TC 9 

PCCN(K) = 3 ZERO DEGREES CF FRcEDCM 
14 CALL VECFUS ( CL( 1 .L ) . QL ( 1 . L 1 I . GL ( 1 • L2 > ) 

IF (LEGL )PR INT 217. L.LCCMLI.L 
IF(LECU1FRINT 217, LI .LCCML1) .LI 
IF (LECU IFF INT 249. L2.L.L1 
IF1LEGU1FRINT 217, L2.LCCN( L21 , L 2 
CO IE I 1 = 1 .3 
1= 1 1 - 1 

IE CALL VECTRN ( GL ( 1 ,L+ l 1 , X XC ( 1 , l . L CON ( L M 1 I . GLCl l . L ♦ 1 1 1 

9 CONTINUE 

AT INERTIAL ORIGIN 
X = XX3-FCGN1 NbOD I 
L = LxPCCN IN 800 1 
CO 19 1=1.3 

XS2 = M ♦ 2 
CO 2 C J-X.X1B2 
2C OFd.JI = 0 
L02 = L-»2 
CO 21 J=L.LB2 

21 CL (I .31 = 0 

19 CONTINUE 

IFILEOUIXO =0 

IGCTC = FCCN (NEOO *1 1 *1 
CO TC ( 22.23 .24 .2 El . IGCTC 

THREE CEGREES OF FREEDCM 

22 XI — X* 1 

X2 = X + 2 
FCCN (XI 1 = 9 
FCCN (X 1 1 = 0 

FCCN (M2 1 = 0 • 

CF ( 1 ,X! 1 = 1 

, GF(2.XI11 = I 

- r CF < 3 .M2 1 = l 

IF(IC.EQ.O) GO TO 26 
CO 2? 11=1.3 
I = 1 1 - 1 

IF (L EGO 1 JM = M+ I 

IF(LECJ IFRINT 214, JX.XC.JXI , ,:t 


C 1 C33600 
Cl C33700 
Cl 033800 
01C33900 
01 C34000 
Cl C34 ICC 
C I 034200 
Cl 034300 
C I C34400 
Cl C34500 
01 C34600 
C1C34700 
Cl C34800 
C 1 C34900 
C l C35C00 
C I C35I 00 
C1C35200 
C 1 03E300 
C1C35400 
Cl C35500 
Cl C35600 
Cl C357C0 
Cl C35800 
C 1 035900 
Cl 036000 
C 1C36100 
C 1 C36200 
C 1 C36300 
C 1 C36400 
0 1 036500 
Cl C36600 
C 1 C367C0 
C 1 C36800 
01036900 
C 1 037000 
01037100 
C l 037290 
Cl C37300 
C I C37400 
C 1 C37500 
C 1 C37600 
Cl C37700 
Cl C3780C 
Cl C37900 
C l C38000 
C 1C38 100 
C 1C38200 
01038300 
C 1 C38400 
C 1 C38500 
C 1 ,C38600 
C 1 C 38 700 
Cl C38800 
C 1 C38900 
C 1 039000 
C 1 C391 00 
C 1 C 39200 
C1C39300 
C 1 C39400 
01 C39500 
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27 CALL VEC TRN { QF ( 1 ,M + I I . X MC ( I . 1 . 0 ) . QFC( 1 . MF I 1 ) 
GO TC 26 

T«C DEGREES CF FREEDCM 
'2 2 M 1 = M F l 

FCCN(M) = 0 
FCCN(Ml) = 0 
LCCN(L1 = 0 
CF ( 1 iM) — l 
CF(2 .Ml ) = 1 
CL(3.L) = 1 
IF (I C.EC.O) GO TO 2b 
IF(L£QU1FRINT 214, M.MC.M 
IF (LEUU IFRINT 214. Ml, MO. Ml 
1FCLEOO JPRINT 217, L.MO.L 

CALL VEC TRN ( OF ( 1 ,M ) . XMC ( 1 . 1 . 0 ) . OF C ( 1 . M 1 1 
CALL VEC TRN (QF( 1 .Ml 1 ,XMC( 1 .1 . 01 ,OFC( 1 . Ml )) 
CALL VE C TRN ( GL ( 1 . L ) . XMC < 1 . 1 . 0 1 , QLC ( 1 . L ) > 

CO TC 26 

CNE OEGREE CF FFEEDCM 
24 LI = LFl 

FCCMM) = 0 
LCCN(L) = 0 
LCCN <L 1 J = 0 
CF ( 1 ,M ) = 1 

CL ( 2 ■ L ) = 1 
CL < 3 ,L1 ) = 1 
IF(IC.EC.O) GO TO 26 
IF (LEOU IFRINT 214, M.MC.M 
IF (LEOU )P« IN T 217. L.MC.L 
IF (LECU IFR INT 217, LI. MO. LI 

CALL VEC TRN ( OF ( 1 , M I . XMC ( 1 . 1 . 3 I . C1FC ( 1 , M I > 

CALL VEC TRN (QL ( 1 .L) . XMC ( 1 . 1 .0 ) ,QLC( 1 ,L ) ) 

CALL VcC TRN (QL( I ,L1 > .XMC( 1 .1 . 3) ,OLC( 1 .LI I I 
GO TC 2c 

2EFC DEGREES OF FREECCM 
2 E LI = LFl 
L 2 = L + 2 
LCCN(L) = 0 
LCCN (LI) =0 
LC CN (L 2 I = 0 
CL ( 1 .L ) = 1 

CL (2 ,L1 > = 1 

CL ( 3 .L2 ) = 1 • - ' 

IF(IC.EO.O) GO TO 26 
CO 26 I 1 = 1 .3 
1=11-1 

IF (LECU ) JL = L + l 
IF (LEOU IFRINT 217. JL.MC.JL 
' ' 26 CALL vEC TRN ( O L ( 1 .L F I 1 . X MC ( 1 . 1 . 0 1 . QLC ( 1 •L+'l’l)-’ 

1 GO TC 26 
C. 

' ,.26. CONTINUE 

lF(IC.NE.O) GO TO 1025 
CO 30 1=1.3 

M8 2 = M + 2 
CO 32 J=M,Md2 
:■ 1 CF C ( I . J 1 = CIF( I , J I 


C I C39600 
01C39700 
Cl C39800 
Cl C3990C 
.C1C40000 
C1C40100 
C 1040200 
C 1 C40300 
C1C40400 
Cl C40500 
C1C40600 
C 1 C40700 
Cl C4O0OO 
Cl C40900 
Cl C41000 
Cl C41 100 
C 1041200 
Cl C41300 
C 1C41400 
C1C41500 
C 1 C4 1 600 
C1C41700 
C 1 C4 1800 
C1C41900 
Cl C42000 
C 1 042 100 
C 1C42200 
C 1 04 2 30 0 
C1C42400 
Cl C42500 
Cl C42600 
01 C427C0 
Cl C42800 
C 1 C42900 
Cl C43000 
C1C43100 
C1C4320C 
Cl C43300 
C 1 C4340C 
C 1 C43500 
C1C43600 
C 1 C4 37 00 
Cl 043800 
C 1 C4 3900 
C1C44000 
C 1 044 1 00 
Cl C44200 
Cl 04430C 
C 1 C4440C 
Cl C44500 
C1C44600 
'■'•■-• •- C1C44700 

Cl C44800 
C1C4490C 
-u . ..o> Cli04.5000 
C1C45100 
C 1 C45200 
Cl 045300 
C 1 C4540C 
C 1 C45500 


A-64 
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LH 2 = L +2 


Cl C45600 


CO 32 J — L • Lti 2 - - 


Cl C45700 

22 

CLC ( I. J) = UL( I.J ) 


Cl C4S600 

i 3C 

CONTINUE 


Cl C A 5900 

1 0 2 £ 

CONTINUE 


Cl 046000 


IFC.NOT. LEQU ) <10 10 1 C 1 £ 


CIC46100 


PRINT 221 


Cl C46200 


CO 6C J=1.NFER 


Cl C46300 

6 C 

PRINT 222. J . ( OF { 1 . J ) • 1= 1. 2 ) . J .( QFCU . J) . 1 = 

1.3) 

C l C46400 


PRINT 221 


C 1 046500 


IF (NLOR .EQ.O )GC TO 1012 


■CIC46600 


CO 61 J=1.NL0R 


Cl 046700 

6 1 

PRINT 222. J , C QL( I . J ) . I = I • 2 > , J .( OLC <1 . J1 . I = 

1.3) 

Cl C46800 


PRINT 221 


Cl C46900 

C 



Cl C4 7000 

C 

CYCLE THROUGH FREE VECTORS PICK. OUT ONES TO 

BE TRANSFORMED IN 

TR ANC 1 C47100 

10 1 £ 

CO 32 J= 1 .NFER 


Cl 04 7200 

3 2 

£ V C ( J ) = 6 


Cl C47300 


K = C 


C 1 C47400 


CC 32 A = 1 .NFER 


C 1 04 7500 

C 

IS FREE VECTOR M FIXED I NER T 1 ALLY 


C1C47600 


IF (FCCN(F) ) 32.36.27 


C 1 047700 

36 

IF ( IC .EC.O) GO TO 34 


Cl 047800 

3 £ 

K = KTl 


C l 04 7900 


£VC< K ) = M 


Cl 04 8000 


CC TC 34 


C 1C48100 

C 

ELEMENTS OF SVO IN SET(J) 


C 1 C48200 

37 

IF (C T A IN (FCON( M) , SET .NSE T 1 ) GO TO 3S 


Cl C48300 

3 4 

CONTINUE ' 


C1C48400 


NS V 0 = K 


C1C4U500 


IF ( .NOJ . LEOU > GO TO 1C0£ 


Cl 040600 


IF (N£V(1 .EQ.O )GC TC 5016 


Cl C407OC 


CO 64 1=1 .NSVQ 


C 1 048800 

64 

PR INT 224. I . S VQ< II 


Cl 0469 OC 


PRINT 221 


Cl C49000 

C 



C 1 0491 00 

c 

CYCLE THROUGH LOCKtO VECTORS PICK OUT CNES 

TU BE TKANSFOHMEC 

IN TR C l 049200 

SO 1 6 

IF INLOR .EQ.O )G0 TOS017 


Cl C493C0 

1 0 0 £ 

CO 36 J = 1 . NLOR 


C1C4940C 

26 

£VF{ J) = 0 


Cl C49500 

30 17 

COM INUE 


C1C49600 


K = C 


Cl C49700 


IF (NLCJR .EQ.O ) GO TC 5025 


Cl C49800 


CQ 35 L = 1 .NLOR 


C1C49900 

C 

IS CCNS1FAINT TORQUE AECLT CL(I.L) COMPUTED 


Cl C50000 


IF ( . NOT .CTAI N(L .SLK.NCTC 1 I GO TO 3* 


C 1 050 100 


(F(LCCN(L)l 4C. 41.42 


C 1 050200 

4 1 

IF (1C. EG. 01 GO TO 39 


Cl C50300 

4C 

K = K ♦ 1 


Cl C50400 


S V F ( K ) = L 


Cl C50500 


CC TC 19 


C l 050600 

c 

ELEMENTS OF SVO IN S&TjC-iJ) 3 ; . 


C1C50700 

4 2 

IF (C TA IN (LCuNl L I . SET .NSE T ) I GO TO 40 


C1C50800 

30 

CENT INUE 


Cl C50900 

L J -50 2 £ 

CONTINUE 

( 

C1C51000 


NS VP = K 

C TC51 1 00 


IF ( .NCT • LEQU) GO TO 101C 


01C51200 


IF(NSVP.EU.0)G0 TC 1 01 C 


Cl C5 1300 


CO 6 S I = 1.NSVP 


C1C5I400 

6 £ 

PR IN T 2 2 £ , I ,SVPl I) • ‘ 

* 

Cl C51500 
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10 1C 


5 2 


c c 


5 7 

£0 1 £ 

5 6 
£0 1 5 
56 


6 £ 
5 5 


- C 
C 


26 50 ALL ARK AY ELEMENTS CF GAM STOWED UPPER TRIANGULAR 
CO £2 K=l,NBOD 
IF ( L EOU )FH INT 232 
CO £2 L=K,NBOD 
KL = KTC INOl .K-l .L ) 

PUT In LOGIC TO AVOID CLOBBERING CODE WORDS STORED BY EOOIV. 
IF(KL.EC.l) GO TO £2 
1FILEQUIK1 = K-l 
IF (LECu )FR INT 21B.K1.L.KL 
CO £ 2 1= 1 , 3 
GAMI.KL) = O.CO 
COAT IauE 

26 RC All ARRAY ELEMENTS CF XCIC STOWED LOWER TRIANGULAR 

CO £2 K= 1 iN31 

IF (L EQU 1FRIN T 233 

CC £2 I=K.NBI 

IK = KT 1 (Ndl . I .K I 

IF (LEOU 1FRINT 215. I.K.IK ' 

CO 5 2 A =1 , 3 
CO £2 A — 1 • 3 
XOIC (M.N.IKJ = O.CC 
IF(LECO)FRINT 221 


FIRST PASS THROUGH. FI AC THE UNION OF ALL LABELS IN THE 

SETS SIX(K) NECC-1 AND THE SETS SON ( K ) , K = 0 . . . . IN BO C- 1 

CO 5 £ I — 1 . NdOD 
S T 2 < 1 1 = 0 
ST A ( l) = 0 

CO 5£ JJJ=1.NBUD 7 

JS=JJJ-1 

CALL UNFACIST 1 .NST1 ,S I X ( J)) 

CALL LNPACIST2 .NST2.SCAC Jl ) cl> 

IF (NET 1 .EO.O )GU TC 5018 - 

CO 57 I=1,NST1 

ST2( ST1 ( I ) > = I 

IF(N£T2 .ECJ.O IGO TC 5015 

CO 5£ 1 = 1 ■ NST 2 

ST4 ( S T2 ( I ) J = 1 

CONTINUE 

COAT INUE 


ASTI = C 

AST 2 = 0 

CO 55 J=1 .NdOD 

IF (S T 3( J l.EO .0 ) GC TO £2 

ASTI = ASTI *1 

ST II AST 1 ) * J . 

IF <STA( J l.EO.O) GC TO 55 

AS T2 =. A ST 2 ♦! - - 

£T2(AST2> = J 
COAT INUE 

CALL CCMFACI ST1.NSTI .SSIXl u. i=i. a.i OtH I, t TP 

CALL CCWPACi ST2.NST2.SSCA) 

IF (LEOU 1PR INT 219. SS I X, (ST l ( l,J , 1 = 1 ,NST 1 1 
IF(LEOU)PRINT 22 0. SSC A , (ST 2 (l » , 1 = 1 . NST2 ) 


Cl C51 £00 
C l C51 700 
Cl C51800 
Cl C51 500. 
Cl C52000 
C 1 C521 00 
C l 052200 
.C 1 052300 
C 1 C52400 
C l C52500 
C 1 C52600 
01 C52700 
Cl C52800 
01C5290C 
C l C53000 
. C 1 C531 00 
C 1 C53200 
C 1 C53300 
C 1CS3A00 
Cl C53500 
C 1 CS 360 0 
C1C53700 
Cl C53800 
01 C53500 
C 1 054000 
C 1 C5A 100 
Cl C5A200 
C 1 C543CC 
C l C54400 
C 1 C5450C 
C 1 C 54 60 0 
0 1 C5470C 
Cl C54B00 
Cl CS4900 
Cl C5500C 
Cl CSS 1 00 
CIC55200 
C 1 C55300 
Cl C5540P 
Cl C55500 
Cl C5560C 
C 1 C557C0 
C I. C 5 5 e 0 C 
Cl C55900 
01 C 560 0 0 
C IC5&100 
C 1 C56200 
Cl C56300 
C 1 C56400 
Cl C56500 
C 1 C56600 
Cl CS6700 
C1C5680C 
Cl C5650C 
$.1 C 5 7 00 0 
C1C57100 
C 1 C57200 
C 1 C57300 
Cl C57400 
C 1 057500 


A-66 


n n 



c-;‘ • • • 

tO 6’ K = 1 iNBOD 
•63 SO KIK)=SUK) 

CALL uNPACISTl .NST1.SKDUM) 

NST1 = NST1 ♦» 

'STH^SM) s NB1 . 

CALL CCMFACl ST1 .NST1 ,SCK IN81I) 

C 

C COMPUTE ACTUAL POSITION CF FCINT MASSES 

C NOMINAL CAC(K) + DISPLACED T HA I M ) *QF C ( M > 

CALL UNPAC (SET ,NSET . SL ) • 

, IFINSET .£0.0 )G0 TC S026 
CO 7 C K K = 1 * N SE T 

K = SET(Kk> • 

MM=SCFIK) 

M*M=MMF2-PCUNIK) 

CO 72 M-MW.MMM 
CO 7 1 I - 1 « 3 

71 CACI I • 1C > = CACll.K) + THAI M I *OFC( I • MI 
IFILEQUIFRINT 228 . K .K .M ,M 

72 CONTINUE 
7 C CONT INUE 

5026 CONTINUE 
C 

ANGULAR MUMENTUM WHEEL 
IF (LECU )PR INT 226 

IF IN MC .EC . 0) GO ■ TO 5020' ' . . 

CO 4 2 J = 1 .NMC 

43 ' SI J ) - C 
502 C CONTINUE 

• K = C 

IF INMG.EC.O) GJ TC 5027 
CO 4 4 J= 1 .NMO 

C H M I I • J i = COMPONENT S CF SPIN AXIS 

C HMCMIJ) = RELATIVE MOMENTUM I.V. AdJUT SPIN AXIS 

CALL VECTRN IHMI 1 . J) . XMC I 1 • 1 .M J( J) ) .HMCI 1 . J ) ) 

C FMCII.JI = SPIN AXIS COMPONENTS IN COMPUTING FRAME 

IF (LE Jl IPR INT 227 . J.MCtd.J 
JJ = MOIJ) 

C ELEMENTS OF SVD IN SETIJ) 

IF I .NOT .CTA1 N( JJ . SET .NEED ) GO TO 44 
K " K ♦ 1 
SI K I - J 

44 CONT INUE 

5027 CONTINUE 

CALL CC MPACl S . K . S VM I 

IF ILEOU JPRINT 2 29. SVM , (S(I).I=1.N> 

C LSE SVM ELEMENTS IN TPANVO TU GET HMC 

IFILECv. IPHINT 233 

IF! .NOT . LEGU) RETURN «• 

IFINMC.EC.O) RETURN 

CO 6 6 J = 1 ,NMO i. 

0 0 be J PRINT 2 2 C . J . ( HMC I I . J ) . I = l . 3 I ! " - ■■■>■-■ >■ ; 

PRINT 232 • } 

2 0 C FORMAT 1*1 SUBROUTINE VCIV ENTERED r >2(/l) ■ ‘ 

20 1 FORMAT I' COMPUTING FRAME IS- BUOY I •*./) 

202 FORMAT I* COMPUTING FRAME INERTIAULY FIXED *./> 

203 FORMAT I' CACI*. 12. •) = XMCl'.1 2.*) * CA( , .12. , I = *.3015.5) 

204 FCRMAT l 2 I / I , 


Cl C57600 
01057700 
C 1 C57800 
Cl C57900 
Cl C58000 
C 1 C5B100 
C 1 C58200 
C 1 C58300 
C 1 C58400 
C 1 C58500 

cicsaeoo 

Cl C58700 
Cl C58E00 
C 1 C58900 
01 C59000 
C.l C591 00 
C1C59200 
Cl C59300 
C 1 C59400 
Cl CS95C0 
Cl C59600 
Cl C5S700 
C 1 C59800 
Cl C59900 
C 1 C60000 
C 1 C601 00 
C 1 060200 
C 1 060300 
C I C60400 
Cl C60500 
Cl C60600 
C 1 C607C0 
C 1 06080C 
C I C60900 
Cl C6I000 
C 1 C6I 100 
Cl C6I200 
C I 061 300 
Cl C61400 
C1C61500 
Cl C6160C 
CIC617C0 
Cl 06 1800 
Cl C6 1 900 
Cl C62000 
C1C6210C 
0 1 062200 
C 1C62300 
Cl C62400 
Cl C62500 
Cl C62600 
Cl C62700 
. C I C62800 
Cl C62900 
Cl 063000 
C 1C6310C 
C 1 C63200 
Cl C63300 
C 1 C63400 
C 1 C63500 
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2C5 FORMAT 121 /) 


20 € FORMAT (44X.3D15.5) 

2C7 FORMAT l* X1CC.I2.*) = 
* = • ,3015.5) 


CENTER CF MASS VECTORS*./) 
INERTIA TENSORS*./) 
xx ci * . 12. • ) * xii 1 


12 . 


) * 


01 C63600 

■ Cl C63700 

■ C1C63800 
C1C63900 

XMCC * . 12. • >**TC1C64000 
- C 1 064 100 


2 oe 

FORM A T 

i / . 

• SVD 

— • 

• Zb 

• 

• ELEMENTS OF SET ARE *.1015. 

/) 

C 1 C64200 

2 C 9 

FORM A T 

(/. 

• SVI 

- • 

• ze 

* 

• ELEMENTS OF SET ARE *.1015. 

/ ) 

Cl C64300 

2 1C 

FORMAT 

(21/1 . 






C 1 C64400 

. • 



• 




FIN Gl VECTORS *,/) 


C 1 06 4500 

2 1 1 

FORMAT 

( • 

CdC ( * . 

12 . 

* ) 

= 

XMCC. 12.*) « Col • , 12 • * ) = • 

.3015.5) 

Cl C64600 

2 1 2 

FORMAT 

( /. 

• S VE 

— • 

• za 

• 

■ ELEMENTS OF SET ARE *.1CI5. 

/ ) 

Cl C64700 

212 

FORMAT 

( Z{ /) • 






Cl C64800 

'♦ 


1 

FREE 


AND LOCK'D COOHCINATE VECTORS 

• ./ ) 

C 1 C64900 

2 14 

FORMAT 

( • 

OFC l * . 

12. 

i \ 

= 

XMC ( * . 12. * ) « QF( * , 12 , ■ ) • > 

• 

■ . C1C65COO 

215 

FORM AT 

I • 

X 0 1 C ( • 

.12 

* * * 

t 

.12.*) = X C 1C€ * . 12 • * ) = 0*1 


C1C65100 

2 16 

FORMAT 

c • 

OFC ( * . 

12. 

• ) 

- 

NURMIOFLC • .12. • ) X GFCC.I2. 

• ) ) • ) 

C 1 C6520C 

2 l 7 

FORMAT 

( 65X. • OLC ( • 

. 12 

• 

•1 = XMCC. 12,*) * GL ( * • I 2 » • ) 

• ) 

Cl C65300 

21 e 

FORMAT 

1 • 

G AM ( • , 

12. 

I f 

• 

12 . • ) = GAM ( * . 12. • ) =- 0 • ) 


Cl C65400 

219 

FORM A T 

(EX 

. • ssi x = 

* • 

Z 6 • • UNION OF ALL LAdELS IN THE- SETS S IX ( K ) C 1 C65500 


♦ARE *.1015) 

2 2 C FORMAT (EX,* 
•* ARE • 

221 FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
. * .301 £.5 1 
229 FORMAT ( 2(/J . 
- • * ' • 
23C FORMAT 
231 FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
* 2 . ■ ) • > 

24 C FORMAT 

241 FORMAT 

242 FORMAT 
*£) 

243 FORMAT 
244-FORMAT 
245 FORMAT 


222 

223 

224 

225 

226 
227 

22 e 


232 

233 

234 

235 

236 
23 7 
236 
239 


SSCN = *.Zfc.* UNION OF ALL LABELS IN THE SETS 

1 C I 5 ) 

121 /) ) 

(• (IF ( * . I 2 . • ) = * .30 1 5. S «SX i 

(• UL (*.12,*) = *.3C1S.S.5X. 

( • S VO( * . 12 . • ) = * . 15) 

( • SVP( * . 12, • ) = • , 15) 


CFC(* .12.* ) 
OLC ( * . 12 . * ) 


= *.3015.5) 

= * . 3015 .5 ) 


I 3( / ) • 25X « ' MOMENTUM WHEELS *, 
(• HMC ( * , 12 . * ) = XMC (*.I2,*) 
(• LAC ( • , 12 « • ) = C AC (* .12,* ) 


/ ) 

* HM ( * . 1 2 , • ) • ) 

♦ THAI * . 12 . ■ >*OFC< • , 12 . • ) 


( 

</. • 

( 39X, 

( ' 

(3<»X. ' 

< 65X. < 

< 35X, < 
(35X. • 
( 35X. ■ 
( 35X. • 


• SVM = * , Z8 . • ELEMENTS OF SET ARE *.10 15)' 

HMC ( • , 12. • ) = • .3015.5) 

SFLX =*.za,* ELEMENTS CF SET ARE *,1015./) 
CA0( • , 12 . < ) = CAl * . 12. • ) • ) 


• ) 


XI C( • , 12 . • ) = 
OLC ( * . 12 . ' ) 
CF( • , 12 ,* ) 
QL ( * . 12 . • ) 
CL ( * . 12 . • > 
QL I * . 12 , • ) 


XI ( * . 12. • ) • ) 

NJRM( CFC( * . 12. • ) X QFCI*. 
OF( * . 12. • ) X CFC • , 1 2. • ) • 

GF< * . 12, • ) X CF( * . 12, • ) • 

OF< * . 12, • ) X CL< • . 12, • ) • 

XMTl ' . 12 . • > **T » QF(*,I2. 


( 35X , • 

(/.* SVA = 

( • FLE ( * . 12 


CL( * . 12 . • ) 

ze , 

) = 


= QL ( * 
ELEMENTS 
FLC ( * . 12. 


, 12. * ) X OLC . 12. • > ■ 

OF SET ARE *.1015,/) 
) 


12 . 

) 

) 

) 

* ) 

) 


01 C65600 
SCN (K ) Cl C65700 
Cl C65800 
Cl C65900 
C 1 C66000 
C1C66100 
1 C1C66200 
Cl C66300 
C 1 C66400 
C 1 C6O500 
= * C 1 C66600 
C 1 066700 
C 1 C66800 
Cl C66900 
Cl C67000 
Cl C67100 
CIC67200 
Cl 06 7 30 C 
C 1 C67400 
> Cl C67500 
Cl C67600 
Cl C6770C 
C1C67800 
• . I C 1 C67900 
Cl 068000 
C1C68100 
Cl C68200 


) > 


X OLC 


< • FLH ( * . 12 , • ) = 

( 6 1 X , 3012.5) 

( • FLO< * . 12 


FLDC.I2.*)**T = ■ , 27X, 3D 12. Cl C68300 

C1C68400 

FLD(*,I2.*) ♦ FL J C » I 2 . ■• ~) =• i30X, 3C 12. 5')- C 1 C68500 

Cl C68600 

XMAS I • , 12 , • )*( FLB( • , 12 . • ) -C 1 C6 8 7 0C 


< ) = FL C ( • . 12 . • ) + 


n 

1 CAO( » . 

12. • ) X flac 

.12. 

• 

) =• , 3012.5) J 




Cl C68800 

24 e* 

FORMAT' 

( 30X , • C A C • 

12 . ■ 

) 

= CAl • , I^i * ) ’ ♦ THAI* . 

12,"* i^FL A( 

• • 12 

. • i * 

1 )C\<bV900 

24 7 

FORMAT 

( 30 X » • XII*. 

12 , • 

) 

= ' xi C , I 2 . • ) ♦ THAI* i 

12, '•")* FL E ( 

' . 12 

. • i < 

1 ) Cl C69000 

24 5 

FORMAT 

( • FLACI * . 12 

. • ) 

- 

XMCC ' , 12. ' )«FLAC . 12 . 

• ) = * . 3 I X » 

30 12 

.5 ) 

C I C69100 

24j9 

FORMAT 

( • F LOC I • • 12 

. • ) 

= 

XMC( * . 12 , • )*FLu( * . 12 . 

• ) i * . 3 1 X. 

30 12 

.5 ) 

Cl C69200 

2 

FORMAT 

(20X, ■ CAC . 

12 . • 

) 

= • • 3D 12 .5 ) 




Cl C69300 

254 

FORMAT 

( 41 X, 30 12. 5) 







C1C6940 0 

255 

FORMAT 

C20X. • XI C. 

12 . • 

) 

= • , 30 12*5) 




C l C6S500 


A-68 


V u 


2 5 1 FCRM A T </,• SVA = >.Ze.' ELEMENTS CF SET AHE *.1015./) 01069600 

257 FORMAT (/////. 40 X .■ FLE * I ELE BODY • . I 3.// > C1C69700 

2S£ FORMAT <30X,' 600V '.I3.' EFFECTS CF ELASTIC MODE •. 13./) C1C69800 

259 FORMAT (15X. • ELASTICALLY DEFORMED CENTER OF MASS VECTOR ANC INERC1C69900 

*TIA TENSCR FCR 60CY '.I3./I C1C70000 

RETURN C1C70100 

FNC • • QIC 70200 


C 

C 

C 

C 


C 

C 


C 

C 


C 


C 


C 

C 

C 

c 


SUERCUTINt ECIV(Y.NEU) 

LSEO TO SET LP INITIAL VALUES FOR RUNGE 


0 1 100000 
C 1 100100 
Cl 100200 
Cl 100300 
C 1 100400 


IMPLICIT REAL* 6 < A-H.0-2.ll i- C1 100500 

LOGICAL FG1 . FG2, FG3. FG4 , F G6 . INEWF. HBLO. Lt QU . LINIT(I) C1100600 

LOGICAL • LKUNGE . L TRNS1 • , L VDI V . LEQUiV . .LTRAN' . 01 100700 

LTRANV . LHATE . LXDY . . LETA . L TO R QU . CllOOBOO 

LQFDOT , LDCT ‘ , LANGLE . LSETUP . LS1MQ C110C900 

. • Cl 101000 

- ■ ■ C 1 10 1 100 

INTEGER Cl 10120 C 


4 

A DORK 


CT1 


CT2 i 

CT3 

9 

C T 4 


CT 5 


F CON. 

. • 

PC C N 


Cl 101300 

* • 

SCNCLM 


SCN 


SCRDUM . 

SCR. 

• 

5FKUUM 


SFK. . 


SFR 

• 

SG 

• 

Cl 101400 

* 

S I 


SIG 


S1XUUA . 

SIX 

» 

SKDUM 


SK 


SL 

• 

SL K 

t 

Cl 101500 

4’ 

SMA 


SMCDUM 


SMC ■ • « 

SMV 


SCK . 


SP IDUM 


SP 1 

* 

SGF 

• 

Cl 101600 

* 

SCL 


SR 


SSCN i 

SSIX 

• 

SVA 


S V d * 


SVD 

• 

SV I 


Cl 101700 


SVM 


3 VP 


SVQ . 

S X M ' 

• 

SXT 


TOKQ 


SMAL 


SEU 

• 

Cl 101800 

* ' 

SC 


SCG 


NFL XB . 

SFLX 

• 

5FXM 


NMODS 


SFCC 

• 

see 

• 

Cl 101900 

4 

IINIT< 1 ) 


IZINIT( 1) 

« 

SOc 








Cl 102000 


. .Cl 102100 

• • ; ' .Oi 102200 

REAL»3 Cl 102300 

* ANGC <2J> . CNF 12.10 . ETIC 13,10) . ETMC C3.10) , C1102400 

* FLO <2.201 . FLE (2.3.20), FLH <3.3.201. C1102500 

* TFACO ( 33 ) . YNCD. (2.2.11). RINIT (l) . RZINIT(l)- Cil0260C 

'•••. Cl 102700 

.01 102800 
Cl 102900 

• • - Cl 103000 

CCMMCN /LOEBUG/ LRCNGE . LTRNSI • LVOIV . LEQUIV . LTRAN . Cl 103100 

« LTRANV . CRATE . LXDY • LETA . LTOROU . 0103200 

* LGFOOT 3 LCCT . . LANGLE . LSETUP . LSIMO . Cl 103300 

Cl 103400 
Cl 103500 


COMMON /LOGIC/ FG1, FG2 , FG3. FG4', FGS . INERF, RBLlHIO) C1 103600 

....... jCi'l 03700 

. . Cl 103800 


CO*MCN 

/ INTG/ 

A»ORK 

< 200 > 

* 



• , 



. Cl 1C3900 

00 


* ♦ S I 4 6 )A.VH 

Cv T2 .si 

* ‘ ) AMT 

V * 

c Jh , 

° i > -> 


CTA , 

> A *. \ . 

■, ,C 1 104000 

* 

C 7 5 

• 

FCON. 

< 22) 


JCCN 

(10) 

* 

LCGN 

< 22 ) 

, C 11041 00 

. 4 

» C 

(10) • 

NB1 


9 

NdOD 


• 

NCTC 


, C 1 104200 

4, 

NFER 

• 

NFKC 


• 

NFRC 


• 

NL.QR 

■ , 

. Cl 104300 

4 

NJ* V 

• 

NMO 


* 

N MO A 


• 

NS VP 


, Cl 104400 

• ■ ' 4 

NSVC 

• 

FCON 

< 11 ) 

t 

SC 


• 

SFR 

(33) ' 

, Cl 104500 

■ ' 4 

SC-*" 


S I 

< 55 ) 

• 

SIG 



SL ‘ * 


, Cl 104600 

4 

SLK 

i23) . 

SMA 

< 10 ) 


SUK 

- (11) 

* 

SGF 

(11) 

, Cl 104700 




A 

SCL 

(11 > 

* 

SMV 


• 

SR 


• 

SSCN 


t 

C 1 104800 

4 

SSI > 


• 

SVA 


> 

SVd 


• 

SVD 


• 

Cl 10490C 

4 

S V I 


• 

SVM 


• 

SVP 

(22) 

• 

SV C 

(32 ) 

• 

Cl' 105000 

4 

SXM 

(2.10) 

• 

SXT 


• 

TURD 

(S)7 ) 

• 

SMAL 


• 

C 1 105100 

4 

3EU 


* 

MO 


f 

SC 

(33) 

» 

SC G 


• 

C 1 1C5200 

4 

NFLX3 


• 

SFL X 


• 

SFXM 

(10) 

• 

NMODS 


• 

Cl 105300 

4 

SFCC 


• 

see 

( 1C ) 








C 1 105400 
Cl 105500 

c i icseoo 

CCMMCts 

/ INTGZ/ 











Cl 1C5700 

4 

SCNCLM 


• 

SCN 

( 9 ) 

* 

SCRDJM 


• 

SCR 

(9) 

• 

0105800 

4 

SFKiClM 

• 

SFK 

( 9 ) 

» 

SIXDUM 

• 

SIX 

( 9 ) 

• 

Cl 105900 

4 

SKDLrt 


• 

SK 

(9) 

• 

SPIOUM 


t 

SP £ 

(9) 

t 

C 1 IC6000 

4 

SFCCUM 


» 

SMC 

( 9) 






, 


Cl 106 100 
C 1 106200 
Cl 106300 

CC MM C N 

/REAL/ 











C l 106400 

4 

CA 

(2.10) 

* 

CAC 

(2.10) 

» 

CL M 

(10) 

> 

CCMC 

(3.11) 


C 1 106500 

4 

DCMC 

(2.11 ) 

t 

ETC 

(3.11) 

» 

£ TM 

(33) 

• 

FUMC 

(3.11) 


Cl 106600 

4 

GAM 

(2.66) 

• 

h 


• 

HM 

(3.10) 

• 

HMC 

(3.10) 


C 1 IC6700 

4 

HMC M 

( 10 ) 

• 

FHl 

(2.11) 

• 

PL M 

(10) 

• 

CF 

(3,32) 


Cl 106800 

4 

QFC 

( 3 . 33 ) 

• 

CL 

(2.22) 

t 

OLC 

( 3.22 ) 

t 

KCMC 

(3.11) 


C 1 1 C6900 

4 

T 


• 




THA 

(33) 

• 

THAU 

(33) 


Cl 1 07000 

4 

ThACM 

( 10 ) 

• 

Th A 4 

( 10 ) 

• 

XDIC 

(3,3.60) 

• 

X I 

(3.3,10 


C 1 107100 

4 

x ic 

(2,3.10) 

• 

XMAS 

( 10) 

• 

XMN 

(33.33) 

• 

XMT 

(3.2.10 


Cl 107200 

4 

TUG 

( 23) 

• 

FLA 

(2.20 

• 

FLO 

( 3.20 ) 

• 

FLC 

(3.20 


Cl 107300 

4 

FLU 

( J. 3, 20 ) 

• 

FlJ 

(2.3 ,20 ) 

• 

CAU 

(3.10) 

» 

X IQ 

(3.3.10 


C 1 107400 

4 

FL IRC 

(2.10) 

• 

FLC9C 

(2.10 

• 

FLAC 

(3.20 ) 

• 

FL GC 

(3.20 ) 


C 1 107500 

4. 

FLCN 

( 20) 

• 

ZE TA 

( 20 ) 

» 

FCF 

( 3.3 .40 ) 

• 

FCK 

(3.40) 


C l 10760C 

4 

TIME ND 












Cl 107700 
01 107800 
Cl 107900 

CCMMCN 

/REALZ/ 











Cl 108000 

4. 

CEDLM 

(1.3) 

t 

C0 

(2.10 

• 

CSCDUM (1,3) 

• 

C3C 

(3.10 

• 

C 1 108 1 00 

4 

X N C C U M ( 1 . 1 , 9) 

• 

XMC 

(2,3.10) 

• 

CBN( .3) 






C 1108200 


EQUIVALENCE 


( E TM ( 1 ) ,TMACC< 1 ) ) 

( XMN ( 1,3). YMCCK 1.1 , 1 ) ) 

( XMN ( 1 .8) . EX ICl 1 , 1 ) ) 
<FLd( 1.1) ,FLO( 1 . 1 ) ) 

1FLH ( 1 , 1 . 1 ) ,FL J( 1 . 1 . 1 ) ) 
(FC1 .L1N1TC 1 ) ) 

{ CtJDUM ( 1 .1 ) . RZ1 N I T(1 )) 
(SCNDUM. IZlMT(l)) 


, (XMN (1,1). ANGO ( 1 ) ) , 

. (XMN (1,6) .CNF (1.1)) . 

. ( XMN ( l , l 0) . e'tmC( 1.1)) 

. (FLE (1.1.1). FL D ( 1.1.1) ). 


, (CA( l.l).filNlT(l)) 

. ( A.QfiKI l ) , 1 IN IT ( I ) ) 


INTEGER ST 1 ( 1 1 ) 
EQUIVALENCE (LEOU IV.LEGU ) 

CINENSICN Y ( NEC) 


ANGULAR CR LINEAR RATE fcITH RESPECT TU FREE AXES' 
IF (LEOU )FRINT 100 
.IF(LE0U)PRINT 101, NFER. 

. C O 1 IS = 1 • Nr E R 
Y(M = TFAO(N) 

IF (LEUU IFRINT 102. N.N.Y(N) 

■CONTINUE 
= N F £ F 


AO VW r'J 


C 1 1 08 J 00 
C 1 ICB400 
Cl l C 850 C 
C l 10860C 
C l IC8700 
Cl 108800 
C 1 1 C 890 0 
‘ C 1 10900C 
C 1 109100 
C l 109200 
C 1 1093C0 
C 1 109400 
C 1 1C9500 
C 1 109600 
C 1 109700 
Cl 109800 
C l 109900 ' 
Cl 1 1 0000 
C 1 11 0 1 0 0 

* cm 0200 

C 1 1 1 0300 
C 1 1 1 0400 

'•Cl 11 0500 
- C l 1 1 0600 
Cl 1 1 0700 


u u u u u 


c 

c 

C GENERALIZED ELAST IC COCRC INATE KATE’ EQUATIONS 

IF CL ECU I PRINT 112. NMODS 
. IF (NMODS .£0. 0 > GO TO 7 
CO 7 N=l. NMODS 
. sa . = NN ■» N 
TINA) = THAO (NA > 

IF(LEUU) PRINT 102. NA , NA , YlHA) 

7 CONTINUE ~ 

NN-= NN NMODS 
C ’ 

c 

C ’ RELATIVE ANGULAR MOMENTUM OF WHEEL ' 

CALL UNPACCST1.NST1.SMV) 

IF CLECU 1FRINT . 1 03 . NST1 
IFCNET 1 .EU.O ) GO TC 5026 
. CO 2 NNN=l . NST 1 
N=NS1 1 -CNNN- I) 

NA ■= NN + NS T 1 + 1 - N 

>CKA) = TFiAD»< ST1 <N) ) , ’ 

IF CLEOU )FR IN T 1 04 . N A , ST 1 < N )’. Y < NA ) 

' 2 CONT INUE 

50 2 6 CONT INLE 

NN = NN ♦ NM V 

’ Cl SPLACtMENT ABOUT. OR ALONG FREE AXES' 

IF CLEUU >Fr< INT, 105. NFRC 

IF CNFRC .£0.0 ) GO TC 5029 . " 

. CO ,3 N=1.NFRC 
N ? EFR CN ) 

NA = NN ♦ N 

• YCNA) = THAI M ) 

IFCLEGU JPRINT 106. NA.M.Y(NA) 

2 CONTINUE “ji ’ ’ 

50 2 9 CCNT INUE ' 

NN = NN+NFRC 

. GENERALIZED ELAST IC^ COORDINATE DISPLACEMENT EQUATIONS 
, . IF CLECU ) PRINT 'l 1 2.' NMODS.,". ' ' 

.... . IF (NMCOS.EQ. C) GO TO 9 

CO 9 N= 1. NMODS ■- " 

• NA = Ms . ♦ N ' 

NST 1 = NFER ♦ N 
>C NA 1 = THAI NST 1 ) 

IFCLECU) PRINT lOfc, NA.NST1.YCNA) 

9 CONT INLE . 

NN = NN t NMODS 

c 

c. r -J o 

C ' DISPLACEMENT ABOUT WHEEL SPIN AXIS 

. IFILEQU)PRINT 107, NMOA, ... . . . 

. . , IF CNNOA -EQ.0 ) GO TO 5030 

! DO -> 4 N=I,NMOA . , , 

M , = SMA C N) ' ‘ 


Cl 110800 
Cl 11 0900 
C1111000 
Cl 11 1 100 
Cl 11 1200 
Cl 11 1300 
Cl 11 1400 
- Cl IT 1500 
Cl 11 1600 
Cl 11 1700 
Cl 11 1800 
Cl 11 1900 
Cl 11 2000 
Cl 1121C0 

cm 2200 

Cl 11 2300 
Cl 11 2400 
' Cl 112500 
Cl 112600 
' C l IT 2700 
* Cl 112800 
Cl 112900 
Cl 11 300 0 
Cl 11 3100 
5 “ Cl 113200 
Cl IT 3300 
Cl 113400 
Cl 113500 
C 1 1 1 3600 
Cl 113700 
Cl 113800 
C 1 11 3900 
Cl 114000 
Cl 114100 
■ Cl 114200 
‘ Cl 11 4300 
Cl 114400 
C l 1 1 4500 
C 1 1 1 4600 
C 1 11 4700 
Cl 1 1 4800 
C 1 11 4900 
Cl 115000 
Cl 115100 
C 1 115200 
Cl 115300 
Cl 1 1 5400 
Cl. 115500 
Cl 115600 
Cl 115700 
Cl 11 5800. 
Cl 1 1 5900 ^ 
Cl 1 1 6000 
Cl 116100 
C 1.1 16200 
1 C111630C 


NA = N N ♦ N Cl 116400 

X NA ) = THAW 1 M ) . ' . Cl 116500 

IF (L EOU )PR INT 1C6. NA.M.Y(NA) ' ' C.l 11.6600- 

4 CONTINUE Cl 116700 


A-71 



SOJC CONTINUE 

NN = NN* NMU.A 

c 

C CIPECT1CN COSINES 

CALL UNPACISTl tNSTItSO) 

IF (LEOO 1FRINT 109. SO . ( S 1 1 ( I ) . I = 1 . NST 1 ) 
1F<LEUU 1FHINT HC. I NEFF 
Iff (NST 1 .EQ .0 1 CO TO E 0 2 1 
N = NN 
M = C 

IF l I NERF .OH. ST 1 (NST1 ) .NE . 1 ) GO TO 5 
NS T 1 = NST1 - 1 

co e jz 1.2 

CO 8 1=1.3 

NN = NN -»l 

Y (NN ) = XMC( l.J.MI 

IF (L ECU) PRINT 1 1 1 . NN . I ,M,Y( NN ) 

£ CONTINUE 

E ( IF<NST l-.EO.O) GO TC £021 
CO 6 N = 1 ,NST 1 
M = STl (N) 

CO 6 u = 1.2 
CO 6 1:1.3 

NN = NN ♦ 1 ' 

V (NN ) = XMC( I . J ,M ) 

IF (LEGU 1PRINT 111, NN. I ,u.l* »Y(NN) 

6 CONTINUE 


SO 2 1 

CONTINUE 


£ 

NEC = 

NN 


100 

FORMAT 

( * 1 

ENTER SUBROUTINE EQIV •) 

10 1 

FORMAT 

( * 

NFER =*,IS) 

102 

FORMAT 

l ‘ 

Y(*,I 2 .«) = Tl-AC ( • . 12 . • 1 = * , 015 . 5 ) 

103 

FORMAT 

( 1 

N ST 1 = * , I 5 ) 

104 

FORMAT 

< * 

YC.I 2 .*) = TPAOt*( • , 12 ., • ) = *, 018 . 5 ) 

1 OS 

FOFMAT 

( * 

NFRC = * , I E ) . 

106 

FORMAT 

l • 

Y(*.I 2 .*l = THAI*. 12 . «> = *, 015 . 5 ) 

1 C 7 

FORM AT 

( ’ 

N 80 A = *, 15 ) 

ice 

FORM AT 

( ’ 

YC.I 2 .*) = T£A*(*.I 2 ,«) = >, 015 . 8 ) 

109 

FORMAT 

( • 

SO =*.ze.* ELEMENTS IN ARRAY STl AHE’, 1015 ) 

1 l c 

FORMAT 

( * 

I NERF = • ,L 10 ) 

1 1 1 

FORMAT 

( * 

Y ( * , 12 .*) = XMC( * . 12 , • . • . 12 , • , • . 12 . * ) z *, 01 E,E) 

1 1 2 

FORMAT 

( • 

NMQDS =■ , 15 ) 


C 


FETUPN 
ENC . 


Cl 116800 
.Cl 116900 
Cl 11 7000 
Cl 117100 
C l 11 7200 
Cl il 7300 
Cl 117400 
Cl 117500 
Cl 11 7600 
Cl 117700 
Cl 1 1 7600 
Cl 11 7900 
Cl 118000 
Cl 1 1 81 00 
C 1 118200 
Cl 11 8300 
Cl 11 8400 
Cl 11 »S0C 
Cl 11 8600 
Cl 11 8700 
Cl 118600 
Cl 11 8900 
C l 1 1 9000 
Cl 119100 
Cl 119200 
Cl 1 1 9300 
Cl 11940C 
Cl 1 1 9S0C 
Cl 11 9600 
Cl 119700 
Cl 119800 
Cl 1 1 9900 
C I 120000 
Cl 120100 
Cl 12020C 
Cl 120300 
Cl 120400 
Cl 120S0C 
Cl 120600 
Cl 120700 
C 1 120800 
C 1 120900 
Cl 121000 
C 1*1 2 1 100 
C 1 121200 
C 1 121300 


c 


- r . 

C 1 2 00000 


SUEHCUTINE TRAN 


C 1200 ICO 

c - 

COMPUTE ALL* TRANSFORMATION 

MATRICES • e 

muv.;i;c 1*200 200 

c 

1) iLse orthogonauity to 

GET MISSING ELEMENTS 

Cl 200300 

c 

2) construct others nct 

IN SO 

C 1 200400 

c 



Cl 20050C 


IMPLICIT REAL*8( A-H.O-2 , l ) 


Cl 200600 

c 



Cl 200700 

c 



Cl 200800 


A-72 



LOGICAL 

PG1 . 

FG2. FG3# 

FG4 , FGS 

. INERF, RBLO, 

L E QU , LIMT(l) 


C 1 20C900 

' • 

LOGICAL 



LRLNGE 

, ltrnsi 


• LVD1V * 

LEO J IV 

• LTRAN • 


C 1 20 100C 


♦ . 



L TRANV 

, LRATE 


• LXOY • 

LETA 


• LTCRQU , 


C 1 20 1 l 00 


.* 



L GF DOT 

, LOCT 


• L ANGLE * 

LSETUP . LSIMQ 


C 1 201 200 

c 













C I 201 300 

c 







* 






C 1201 AOO 


integer 












C1201500 


V A KfcC F* K 

• CT1 

• 

CT2 

. CT 3 


CT4 * CT 5 

• 

FC CN 

• PCON 

• 

C 1 20 1 600 


* S CN COM 

t SCN 

t 

SCROLL 

. SCR 


3FKDUM t SFK 

• 

SFR 

• SG 

t 

Cl 201 700 


* S I 

• S IG 

• 

S X XDU M 

. SIX 


SKDUM • SK 


• 

SL 

• SLK 

• 

C 1 201800 


* SFA 

, SMC DU M ■ 

SMC 

. SM V 


SDK . SP1DUM 

• 

SPI 

• SQF 

• 

C 1 201900 


* SCL 

• SR 

• 

S SC N 

. S£ IX 


SVA • SVd 


SVD 

. SV I 

• 

Cl 202000 


* SVM 

• SVP 

• 

SVQ 

. SXf 


SXT • TOKO 

• 

SMAL 

« SEU 

• 

Cl 2021 OC 


* sc 

• SCG 

* 

NFLX8 

. SFLX 


SFXM • NMCDS 

« 

SFCC 

. see 

• 

C 120220C 


* IINITtl) 

• 

I21NIT< 1 ) 


SD 




J 


C 1 202300 

c 













C 1 202400 

c 













C 1 202500 


RE AL*6 












Cl 202600 


* ANGC 

( 33 ) 

• 

CNF 

( 3, 1C) 

• 

ETIC <3,10) 

• 

ET MC 

(3*10) 

• 

C 1202700 


* FLO 

<3,20 ) 

• 

FLE 

<2.3.20) 

• 

FLH (3.3 

.20 ) 

* 




Cl 202800 


♦ T HA CD 

(23) 

t 

YMCD 

<3.2.11) 

• 

RIMT ( 1 ) 


• 

R2IN IT < 1 ) 


C 1202900 

c 













C 1 203000 

c 













C 1203100 

c 













C 1 203200 

c 













Cl 203300 


CCMMCN 

/LDEBUG/ 

L RUNGE 

, L T R NS I 
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• LXDY , 
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C 1 2035C0 
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C 1 203600 
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C12C4I00 


COMMCN 

/INTO / 
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• 
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• 
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* 
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* nfef 



NFKC 



NFRL 
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t 

C 1 204600 


* NMV 



NMG 



NMCA 



NS VP. 


• 

C 1 204700 


* NSVC 



FCON 

(11) 


SO 



SFR 

(33) : 

• 

C 1 204800 


♦ SG 



S I 
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SIG 



SL 


* 

Cl 204900 


♦ SLK 
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SMA 
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SO K (11) 



SOF 

(11) 

• 

C 1 205000 
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(It) 


SM V 



SR 



SSCN 


• 

C1205100 


♦ SSIX 



S VA 



SVd 



sve 


• 

C 1 205200 


* S V I 



SVM 



SVP (22) 



SVG 

(33) 

• 

C 1 205300 


* S XM 

(2.10) 


S*T 



TORO (J 7) 



SMAL 


• 

Cl 205400 


* SEU 



NTQ 



SC (S3) 



SCG 


* 

Cl 2C5500 


* N F L > 0 



SFLX 



SFXM (10) 



NMOOS 


V 

C 1 205600 


* SFCC 
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• 


C 1205700 

c 













Cl 205800 

c 













C V 2C5900 


CO MM C N 

/ INTG2/ 










* 

Cl 20600C 
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• 

SCN 

1 9) 

» 

SCROUM 


• 

SCR 

(9> 

• 

C 1 2061 CO 


* SFKCLM 


• 

SFK 

< 9 ) 

• 

S I XDUM 


• 

SIX 

(9) 

• 

C 1206200 

OO&OO&i :SKDLM 


• 

SK 

<9> 

• 

Se.IOUM. .} 

, 

• » 

SP I , , ■ 

< 9 ) . .. 

t 

Cl 206300 


* S N C C CM 


• 

SMC 

<9) 








C 1 206400 

c 













Cl 206500 

c 













Cl 206600 


CCWMCN 

/REAL/ 











C 1 2C67C0 


* CA , 

(2.10) 

f 

CAC 

(3.10 

• 

CL M (10) 


* 

CCFC 

(3.11) 

• 

Cl 206800 
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n n 


* 

OCMC 

(3.11) 


ETC 

(3.11) 


ETM 

(33) 


FCMC 

(3.11) 


C12C590C 

* 

GAM 

<3.66) 


h 



HM 

(3.10) 


HMC 

(3.10) 


: C 1 2C 7000 

* 

HMCM 

1 10) 


PH I 

(3.11) 


PL M 

( 10 ) 


QF 

(3.33 ) 


0207100 

★ 

QFC 

(3,33) 


Cl 

(3,22) 


QLC 

(3,22) 


FGMC 

(2.11) 


Cl 207200 

* 

T 






THA 

( 33) 


THAO 

(33) 


C 1 207300 

* 

TFAC« 

(Id 


T HA 4 

( 1C) 


XCIC 

(3.3 .66 ) 


XI 

(3.3.10 


Cl 207400 

* 

x ic 

(2.3.10) 


XMAS 

(io) 


XMN" 

( 33 .33) 


XMT 

(3.2 .10) 


C-l 2C7500 

4 

T LG 

(23) 


FLA 

( 3,20 > 


FL6 

(3.20) 


FL C * 

(3.20) 


C 1 207600 

4 

FLO 

(3.3.20) 


FL J 

(3.3 .20) 


C AO 

(3.10) 


X IQ 

(3.3,10 


Cl 2C7700 

* 

FL I PC 

(3.10) 


FLCRC 

(2,10 


FLAC 

(3.20) 


FLUC 

(3.20) 


C l 207800 

♦ 

FLO) 

( 20) 


ZETA 

(20) 


FCF 

(3,3.40) 


FCK 

(3.40 ) 


Cl 3C7900 

* 

T IMENB 







- 





„C t 208000 














01208100 














C 1 2C820C 

COMMON 

✓RE ALZ/ 











Cl 208300 

* 

C ED LM 

(1.3) 

• 

Cb 

(3,10 

• 

C JCDUM (1,3) 

• 

CBC 

(3.10) 

• 

C 1 2C84C0 

* 

XMC CLM < 1 . 1 , 9) 

t 

XMC 

(2,3,10) 

t 

CdMil 






C i 208500 


EOCI VALENCE 


( ETM{ J ) . THACC ( 1 ) ) 

( XMN ( 1 .3) . YMCD< 1.1 .11) 

{ XMN ( 1 ,6 ) .ET 1C( 1.1)1 
<FLB( 1.1). FLC< 1 . 1) ) 
IFLH( 1,1.1 I.FLJll.l.n) 
(FG1 .LINITl 1 ) ) 

( CbDU M ( I.II.F21MTUII 
( SCNDLM. 121MTUH 


, < XMN ( 1.1) . ANGD( 1 ) ) . 

. ( XMN ( 1 .6) . CNF ( 1.1)) , 

. 1 XMN ( 1,10) .ETMC( 1,1)) , 

. (FLE ( IV 1 • 1 I.FLDI 1.1. 11), 

• A ' ' 

, (CA( I . 1 ) .R INCT( 1 ) ). 

. ( A»OPk( 1 ) . 11NITI 1 ) ) 


LOGICAL CT AIN 
' C I ME N S l L N TtMPUJ,3) 

CtMENS ILN XMS( 3.3 ) ,0(2 ) . C S ( 2 ) « TEM(3,2) ,TEMP(3,3) 
INTEGER STll 10I.SETI 15) 

EQGIVAlENCE (LTRAF.LtQU 


IF(.NOT. LEOU) GO TO 10CC 
. FR INI ICC 

' JO = c 
j 1 = 1 
’ ,.J2 = 2 
J3 = 2 

PRINT 1C1. INERF 

CALL GNPAC ( SET.NEET.SO) 

IF (L ECO ) PR IN T 102. SO , I SET! I ) . 1 = 1 .NSET ) . 
IF (N SET .ECi.O ) GO TC 5022 
KST = 1 

IF ( INERF .UR . SET< NSET) .NE .1 ) GJ TO l 

NSET = NSET - 1 

KST = 0 

K = C 

KK=KST 

IF (K'T.GT.NSET)GO TO 5022 
IF IKK. EG .0) GO TO 19 
-K = SETIKK) 

•CALL VECFUS ( XMCI l . 1 ,K ) . XMC 11 . 2. k > . XMC ( 1, 
IFI.KOT. LEGO) GO TO 2 
PRINT 1 C A 

PRINT 115, ( XMC ( 1 . I ,K) ,1=1 ,J) 

PRINT 115. K, ( XMC 12 . I ,K ) ,1 = 1 ,3) 


Cl 2086C0 
Cl 208700 
C 1 208800 
C l 208900 
C I 209000 
C 1 20 9 IOC 
C 1 209200 
C 1 209300 
C 1 209400 
C l 209500 
C 1 209500 
Cl 209700 
C 1 209800 
Cl 209900 
Cl 21 0000 
C 1 21 0 1 00 
C I 21 0200 
C 1 21 0300 
C 1 21 0400 
C 1 21 0500 
Cl 21 0600 
C 1 21 0700 
Cl 210800 
0210900 
C l 21 1000 
C l 211100 
C 1 21 1200 
C l 21 1 300 
C 1 21 1 4C0 
C 121 1500 
Cl 21 1 600 
Cl 21 1 700 
Cl 21 1 800 
.0121 1900 
'Cl 21 2000 
Cl 21 2 100 
C 1 2 1 2200 
C 1_21 2 30 0 
*C 1 = 21 2400 
C l 21 2500 
C l 212600 
Cl 21 2700 
C l 212800 


A-74 


PRINT 115. ( XMC (3. I .K ) .1= 1 .3) 

2 CCNT INU£ 

KK = K K * 1 

IFIKK.LE.NSET) GO. TO 5C21 
£022 CONTINUE 
C 

c ■ CCMPlTS ELEMENTS OF TRANSF GRMAT TON MATRICES OBTAINABLE 

c VIA SMALL ANGLE ASSUMPTIONS OR EULER ANGLES 

C . ■ ... 

IS = SR - SO 

: CALL UNPAC (SET ,NSET , IS 1 
CALL LNPACCSTI.NSTl.SMAL> 

IF ( .NOT . LEOU ) GO TO 3 

PRINT 1 C 7 * I S, < SETC I > . 1 = l.NSET ) 

PRINT IC4 

2 IF (NEET .EQ.O > GO TC E022 
CO 4 I I 1 = 1 .NSET 
JJ J = N SE T-(III-l) 

JJ = .SET I J 3 J 1 

„ = JCCMJJ) ... 

CO 2 0 1 = 1. 3 

CO 2 C L = 1 . 3 

2 C TEMPU.L) = XMT(I.L.JJ) 

C CHECK FCP THREE CONSTRAINED AXES 

IF (PCCM JJ 1 . NE .3) GG TC £026 
CC 25 1=1,3 
CO 27 L = 1 . 3 
KM £ { I . L ) = TEMPI I .L I 
27 CONTINUE 
£326 CONTINUE 

MOCNE = 2-PCCN(JJ) 

CO 5 I 1 = 1. MD CNE 
1=11-1 

C CYCLE THROUGH FREE COORDINATE ROTATIONS AT HINGE POINT JJ-1 

M = 'OF(jJ) ♦ I 
KB = £ XM(I+1 .JJ) 

C CHECK SMALL ANGLE ASSUMPTIONS 

E = 1HA(M) 

C = l.OCC 

1F(CTAIN(JJ.ST1 ,NST1 1 > GC TC 22 
E = CilNCTHACMl l 
• C = CCOSCTHAtMl > 

.22 CONTINUE 

IFl.NCT.LEOU) GU TC 5027 , 

PRINT 120, JJ, J.I.M.Ke.fc.C 

12C FORMAT (• JJ =•.13.' J = • , I 3 » • l =•,13,’ M s',13.’ KB =•.13. 
* .0 17 .d . • C = • ,D1 7 .e) 

5027 CONTINUE (• 

CALL ROT<6. C.KE, TEMPI > 

CALL MATMULI TEMP , TEMPI ,XMS, 2 ) 

CO 2 £ L= 1 . 3 
CO 2 £ LL= 1,3 
‘ TEMP(L.LL) = XMS(L.LL) 

25 CCNT INUE 

\J C. 2s 1 jt i y 

E CONT INUE 

IF(LECU) PRINT 110, (( TEMF( I.L) .L=l .3) .1=1 .3) . 

(ALL MA TMULI XMT( 1 . 1 , JJ ) , TEMP .XMS.3) 

IF(.NCT. LEUUI GO TO 1 CO 2 
PRINT 104 

PRINT 1 C 9 , ( XMS< 1 , 1). . 1 = 1 .3 ) 


C 1 21 2900 
Cl 21 3000 
C 121 3100 
Cl 21 3200 
Cl 21 3300 
C 121 3400 
C l 21 3500 
Cl 21 3600 
Cl 213700 
Cl 213000 
C 1 21 3900 
C 1 21 4000 
C 1214100 
C l 21 4200 
C 1 21 4300 
C 1214400 
C 1 2 1 4500 
C 1214600 
C 1 21 47C0 
C121480C 
C 1 21 4900 
C 1215000 
Cl 21 51 00 
C 1 21 5200 
C 1 21 5300 
C 1215400 
C 121 5500 
C 1 21 5600 
C 1 21 570C 
C 1 21 5800 
Cl 21 5900 
C 1216300 
C1216100 
C1216200 
Cl 21 6300 
Cl 21 6 4 C 0 
C 1 21 6500 
C 1 2 1 6600 
C i 21 6700 
C12168C0 
Cl 216900 
C 1217000 
C 1217100 
C 1 21 7200 
Cl 21 7300 
B =*.C1 21 7400 
0121 7500 
Cl 21 7600 
C12I7700 
C 1 21 7800 
C l 21 7900 
C 1 21 8000 
C1218100 
.0 21 8200 
Cl 21 8300 
C 1 21 8400 
C12ie500 
C 1 21 8600 
C 1 21 8700 
Cl 21 8800 
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u u 


ioo: 


PRINT lie. J J. IXMSI2. I >. 1=1 .3) 
PRINT ICS. I XMSI 3 . I ) . I =1 .3 ) 

PRINT 134 

IFIJ .NE.C) GO TO 16 

iFlINERF) GO TC 1 7 

co i: i=i .3 

CO 1 £ L = 1 . 3 

XMCI I ,L .C ) = XMSI U . I ) 

IF I . NOT . LEOU) GO TO 4 
PRINT 112. I XMCI. 1 .1.0) .1 = 1 .2 1 

J.JJ.I XNCI2 . 1.0) .1^1 ,3) 
( XMCI 3 .1.01.1=1.2) 


1 7 
le 


le 


4 

£032 


PR INT 
PR In T 
PR IN T 
GO TC 
co ; 1 £ 

CO 1 £ 


112 . 
1 12 . 
1 C4 
4 

1=1 
L = 1 


.3) 


XMC I I .L . 1) =XMSi I .L) 

IFl.NOT. LEOU) GO TO 4 
PRINT 1 12. (XMCI 1 . I . 1 ) . 1 = 1 .2 1 
PRINT 114. J J , J J , (XMCI 2.1.1 )«! =1 i 
PRINT 1 12. IXMC <3. 1 . 1 ) . 1= 1 .2 ) 

GO T C 4 - 

CALL MATMULI XMCI l . 1 . J) . X»S .XMCI 1 . 1 .JJ) .3) 

IF I. NOT. LEUU) GO TO 4 

PR INT 1 OS. IXMCI 1 . I . JJ) . I = 1 .2) 

PRINT 1C6. JJ. J, J- . I XMCI 2. I .JJ) . 1 = 1 .3) 
PRINT 1 CE. IXMC 13. I .J J ) . 1= 1 .2 > 

PRINT 104 

CONTINUE 

CONTINUE 


LPCATE TRANSFORMATION MATRICES 
CALL UNPACISET.NSET.SL) 

IFINSET .£0.0 ) GO TC 5033 
CO . 1 2 J J J =1 .NSET 
JJ = SETIJJJ) 

J. ! = JCCNI JJ ) 

CO 14 1=1.3 

CO'. 1 4 L = l .3 

14 XMCII.L.JJ) = XMCII.L.J) 
IFILEOO) PRINT 111. JJ.J 
1 2 CONTINUE 
£022 CONTINUE 

IFILEQO) PRINT 104 


ASSOCIATED »1TM LINEAR OSCILLATORS 


■A I. 


100 

FORMAT 

I • l 

SUBROUTINE 

TRAN ENTERED •,//) , . 

10 1 

FORMAT 

I • 

I NERF = • .L5 

»/) ■ ... 

102 

FORM AT 

I • 

SO = • ,28. • 

SET ELEMENTS ARE *.1015.//). 

10.4 

FORMAT 

I * 

• ) 


1 OE 

FORMAT 

l 80X 

. 30 17 . e) 


i ce 

FORMAT 

I • 

XMC I * . 12 , • > 

= XMCI • . 12. • > *XMS( 12. • ) = *.3017.8) 

10 7 

FORMAT 

I • 

SR-SC.= • 

.28.* SET ELEMENTS ARE. *.1015,//) 

ICS 

FORMAT 

I 12X.3017.ei 


1 1 C 

FORM AT 

I • 

XMSI • . 12 . ■ ) 

= *,3017.8) 

1 1 1 

FORMAT 

I/. • 

XMCI * . 12 . • 

) r XMCI*,I2.*> •) 

1 1 2 

.FORMAT 

I2EX 

.3017.8) 

* -■ . a ; i - w . > 1 o 

l 1 2 

FORMAT 

I • 

XMC I • . 12, • ) 

= XMSI* .12.* )**T => *.3017.8) 

1 1 4 

FORMAT 

l • 

XMCI • . 12. • 1 

= XMSI*. I 2.*) = * . 3D 17.8) 

1 l 5 

FORM AT 

I 12X 

,3017.8) 


1 16 

FORMAT 

I • 

XMC I * . 12 . • > 

= *.3017.8) 

1 1 e 

FORMAT 

I.* 

TEMP =*.3D17 

. 8 1 


Cl 21890C 
Cl 21 9000 
C 1219100 
C 1 21 920C 
Cl 21 9300 
01219400 
Cl 219500 
C l 21 96 0 0 
C 1219700 
C 1219800 
C 1 21990C 
Cl 22 0000 
0122010C 
C 1 220200 
01220300 
C 1 220400 
C 1 220500 
C 1220600 
Cl 22 0 7 00 
CT220800 
Cl 220900 
C 1 22 1000 
Cl 22 l 100 
C 122 1200 
Cl 22 1300 
C122140C 
C 1 22 1 SCO 
C 1 22 1 600 
C l 221 7 00 
C l 22 1 800 
C 1 22 1 900 
Cl 222000 
C 1 222 1 00 
C 1 222200 
C 1 222300 
C 1222400 
C 1 222500 
C 1 222600 
Cl 222700 
Cl 222800 
Cl 22290C 
Cl 223000 
‘ C 1 223100 
C l 22 32 0 0 
Cl 223300 
C 1 22 3400 
Cl 223500 
C 1 22 3 600 
Cl 22 3 700 
Cl 223800 
Cl 223900 
Cl 224000 
C 1 224100 
C 1 224200 
JZ 1,224 300 
C 1224400 
C l 224500 
Cl 224600 
C122470C 
Cl 224800 


n n n n 


RETURN 

END 


Cl £24900 
Cl 225000 


C 

c 

c 

c 

c 


c 

c 


c 

c 


c 

c 

c 

c 


Cl 200000 

SUEKCUTINE TRANVD C 1200100 

TRANSFURM5 ONLY THCSfc VECTORS AND DYADS TIME VARYING IN C13C0200 

COMPUTING FRAME Cl 300300 

C.l 200400 
. Cl 200500 

IMPLICIT REAL4aCA-H.0-2.il 1 C1200600 

LOGICAL FG1 . FG2. FG3. FG4 • F G5 . INERF. RBLO. LEQu. LIMT(l) 1 C1200700 

LO.GICAL LPLNGt • LTRNSI . LVDIV • LEUUIV ,■ LTRAN . • C1300B00 

* LTRANV • LRATE • LXDY . LET A , LTORQU • * C13CC900 

, LCFOOT . LDCT . LANGLE' • LSETUP . LSIMO 0301000 

C1201 100 
C 1301200 

INTEGER C 1 30 1 300 


* 

A4CRK 

• CT1 


CT2 

• CT3 


CT4 


CT 5 . 

FCUN 

. PCCN 

• 

Cl 301 400 

* 

SCNCUM 

• SCN 


SCROUV 

• SCR 


SFKDJM 


SF K ' • 

SFK 

. SG 

• 

C 1301 500 

♦ 

S I 

• SIo 


SIXDU* 

« SIX 


SKDUM 


SN • 

SL 

. SL X 

• 

C 1 201600 

* 

S VA 

• SMC DU V 


SVC 

• SMV 


SDK 


SP1DUM. 

SPI 

. SOF 

• 

C 1 301 7.00 

* 

SCL 

• SR 


S SC N 

• ss ix 


SVA 


sv a . 

SV D 

. SV 1 


C 1301600 


SVM 

• SVP 


SVO 

* s X V 


SXT 


TORO . 

SMAL 

, SEU 

• 

Cl 201 900 

* 

SC 

. see 


NFLX8 

• SFLX 


SFXM 


NMCDS • 

SFCC 

. see 

• 

C l 302000 

* 

I IN IT! 1 1 


I/INITC 1 1 


SD 






C 1 302 100 














C 1 202200 



1 











Cl 202300 

real* a 












C 1 302400 

* 

. ANGC 

( 23) 

t 

CNF 

(3.10) 

• 

ETIC 

(3 

.10 ) . 

ETMC 

(3.10) 

• 

C 1 302500 

* 

FLQ 

<3.201 

• 

FLE 

( 3.3.20) 

• 

flh • 

(3 

.3 .20 ) , 




Cl 302600 

* 

TFACD 

(23) 

• 

YMCD 

(2.2.11) 

• 

KINIT 

(1 > . 

R21NIT(1) 


C 1 2O270C 


Cl 302800 
...... 1 01 302900 

J C 1 303000 

• C 1 303 100 

CGEMCN /LCcdUG/ LRLNGE . LTRNSI . LVDIV . LEQUIV , LTRAN C1303200 

* LTRANV , LRATE . LXDY , LET A , LTORQU . C1203300 

4 LCFOOT . LOCT . LANGLE • LSETUP . LSIMQ 0303400 

Cl 303500 

* Cl 303600 

COMMCN /LOGIC/ FG 1 . FG2 « FG3. FG4. FGS. INESF. KBLO(IO) C1303700 

C 1303B00 
C 1 203900 

' CQMMCN /INTO/ AWCRM200). . C1204000 


4 

CTi 


• CT2 


• 

CT3 


t CT 4 


. C 1 304 10 0 

♦ 

CT5 


FCON 

(33) 

» 

JCON 

(10) 

» LCCN 

( 2 £ ) 

. C 1 304 20 0 

* 

Ac 

( 10) 

. r\ei 


• 

N3 0D 


• NCTC 

. ' . 

. C 13.0430 0 


NFEfi 


• NFKC 


• 

NFKC' 


: V NLOR . 

• . 

. 0204400 

* 

NVV 


• AVO 


t t " v 

NMOA * 


• INS VP- 


. C 1 304500 

V 

NSVC 


. FCGN 

(11) 

• 

SD 


. SFR 

( 33 ) 

. Cl 304600 

"* } 

* 

•> 

SG 


• % r I - ' 

( 55) • 

T * \f 

SIG 

' ' ,v a r 

• SL ’ 

• 

, C l 3 04 70 0 


SLK 

( 33) 

• SMA 

( 10) 

• 

SDK 

(11) 

• SQF 

(11) 

. C 1 304800 

♦ 

SCL 

(11) 

• SW 

’ 

• 

SR 


t SSCN 


, C l 304900 

* 

SS I X 


•, SVA 


t 

sve 


• SVO 


. C 1 305000 

* 

SV I 


• SVM 


• 

SVP 

(22 > 

• SVO 

1 33 ) 

. Cl 3051 00 

* 

SXM 

(3.10) 

. SXT 


• 

TURO 

(97) 

• SMAL 


. C 1305200 
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on n n ■ no n n 


c 


c 

c 

c 

.c 


* 

SEU 


• 

NTQ 


• 

s c 

( 33 ) 

• 

SCG 


• 

C 1 305300 

* 

:nfl xo 


• 

SFL X 


t 

SFXM 

1 10) 

• 

NMCDS 


t 

C 1 3 05 AO 0 

* 

SFCC 


0 

see 

(1C) 








' C I 305500 
C 1 305600 
Cl 305700 


CCMMCN 

/ INTG 2/ 











C 1 305800 

♦ 

SCNCLM 


0 

SCN 

(9)' 

• 

SCROUM 

• 

SCR 

(9) 

• 

C 1 305900 

* 

SFKCLM 


• 

SFK 

19) 

• 

6 I X CUM 

• 

s i x 

(9) 

• 

C 1 306000 

* 

SKOt U 


• 

SK 

(9) 

• 

SPIDUM 


• 

SP I 

(9) 

• 

C 1 306100 

* 

SMCCLM 


• 

SVC 

( 9) 








C 1306200 
C 1 306300 
C 1 306400 


COMMON 

/real/ 











Cl 306500 

* 

CA 

(3.10) 


C AC 

(3. 1C) 


CLM 

( 10 > 


CCMC 

(2.11) 


C 1 306600 

* 

DCMC 

(2,11) 


ETC 

(3,11) 


t T M 

(33) 


FUMC 

(2.11) 


Cl 3 C 6 700 

* 

GAM 

(2.66) 


H 



HM 

(3.10 


HM C 

(3.10 ) 


C 1 306800 

♦ 

'hmom 

( 10) 


Ph I 

(3.11) 


PLM 

(10) 


GF 

(3.32 ) 


C 1 306900 

* 

Q FC 

( 3.33 ) 


GL 

( 3.22 ) 


ULC 

( 3.22 ) 


KCMC 

(3.11) 


C l 307000 

>1 

T 






THA 

( 33) 


THAD 

(33) 


C 1 30 7 100 

* 

THAC» 

( 10 ) 


THAW 

( 10) 


XDI C 

(3,3, 66 ) 


XI 

( 3,3. 1C) 


C 1 30 7200 

* 

X 1C 

(2.3,10) 


XV A S 

( 1C ) 


XMN 

( 33.33) 


XMT 

(3.3.10 


C l 3C7300 

* 

tlg 

(23) 


FLA 

( 3.20) 


FLd 

(3.20) 


FlC 

( 3.20) 


C 1 307400 

* 

FLO 

(3. 3.20 ) 


FL J 

( 2 .3 .20 ) 


CAU 

(3.10) 


X l u 

(3.3.10 


C 1 30 7500 


FL IRC 

(2.10) 


FLCRC 

( 2. 1 C ) 


FLAC f 

( 3.20 ) 


FLQC 

(3.20 


C 1 307600 

* 

FLCM 

(20) 


zeta 

( 20 ) 


FCF 

(3.3 .AO ) 


FCK 

(3,40) 


• Cl 307700 

* 

T IMENO 












C 1 307800 
C 1 30 7900 


CCMMCN /REAL 1/ 
* CEDLM (1.3) 

t CE 

(3.10) . CdCDJMll.3) 

. C3C 

( 3. 1 C ) 

• 

* XMCCUMI 1, 1 ,9) 

• xvc 

(2.3.10). CoN( 3) 





EOLI VAuENCE 


(ETM( 1 ) . TH ACC ( 1 ) ) 

( XMN ( 1,3), YMCD’C 1.1.1)) 

( XMN( 1 .8 ) . ET IC < 1 V 1 ) )° J 
(FED ( 1,1 ) ,FLQ( 1.1)) 

( FLH ( 1.1.1 ) .FL J( 1 . 1 . 1 ) ) 
(FG1 ,LINIT( 1 )) 

( C BD UM( 1.1IiR2!K1T(1|I 
< SCNDLM , IZ IMT ( 1 ) ) 


. ( XMN ( 1 . 1 ) . A,\lOD< 1 ) ) 

. CXMNt 1 , 6 ) . CNF ( I. 1 ) ) , 

. ( XMN ( 1,10) .ETMC( 1.1)) . 

, (FLE (1.1,1) . FLD( 1.1.1)). 
* 

. ( C A ( l.l).RINlT(l)) . 

, ( A»OWK ( 1 > . IIN1T( 1 ) ) 


LOGICAL CTA1N 
CIMEN3ICN TEM(3) 

Cl MEN SIGN TEMK3.3) 

IN1ECER STIC 10),SET(18).SFXMN 
EQLIVALcNCE (LTRANV.LECU ) 


1F((_EGU)FRINT 2CC 


c i ;-oaoco 
C 1 308 1 00 
. C 1 308200 
C 1 308300 
c i soeAoo 

C 1 308500 
C 1308600 
C 1 308700 
Cl 308800 
Cl 3C8<300 
C t 309000 
C 1309100 
C 1 309200 
C 1 309300 
C 1 2C9400 
Cl 3095C0 
C 1 309600 
Cl 309700 
C 1 309800 
C 1 3C9900 
Cl 31 0000 
C l 31 C 100 
01310200 
Cl 31 0300 


ELASTIC CEFuRMAT I CN PARAMETERS 
IF (NFLXc .EO. 0). GO TO 15 
MN = C 

CALL LNPAC(SET .NSET.SFLX) 

.CALL UNP AC ( ST 1 .NST 1 . SVC ) 

IF (N SET .60 .0 ) GO TC 5000 
CO 1 6 NN = 1 .NSE T 
N = SE T ( NSE T + 1-NN) 

: iflx = C 


I j , ( j . C l 31 0400 
C 1 31 0500 
C 1 31 0600 
Cl 31 070 0 
T ( . , • ■ •-> C 1 31 0800 

C l 31 0900 
C 1 31 1000 
C 1 31 1 1 00 
C 121 1200 
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IF IC TA1MN .ST 1 ,NST I i ) GO TO 19 
• If lx = 1 

15 CONTINUE 

IF IFlx=C MuCAL vectors and tensors fixed in 
BCDY N FUST OE TPANSFCRFEC 

: CCFPLTE CEFURMED CF VFCTCP AND INERTIA TGNSCR OUDV N FIXED FRAME 

IF! .SOT. LEOU ) GO TC 1000 
FPIM ilfiN, 

PRINT EC 6 
100C CONTINUE 

CO 17 1=1,3 
< A I I ,N i = C A C ( I • N ) 

CO 1 7 J= 1 . 3 

17 XIII. 3, N) = XIOIl.J.N) 

IF ( .NOT .LEOU ) GU TC 1001 
print eec. n .n 
PRINT 221. N.N 
PR INI 20E 
IOC 1 CCNT INUE 

SFXMN = SFXMIN) 

CO I 6 M=1.SFXMN 
FN = FN+I 

call sclvi Thai nfer+mn) ,flai i ,mn> . temi . 

CALL VECADDI CAI 1 .N ) .TEF .CA( 1 ,N) ) 

CALL SCLCI THA(NFERAMN) ,FLE( 1 . 1 .MM . TCM1 ) 

CALL CYACDCXII 1.1 .N) • T E M 1 .XII1.1.N) 1 

IF I . NC T . Lt CJU ) GO TC 1CC2 

NFXF = NFER+FN 

PRINT 21t. N.N, NFXF, MN 

PRINT 217. N.N, NFXF, MN ' 

PRINT 2C6 
1002 CONTINUE 

IF I I FLX .EG. I ) GO TC 20 

CALL VECTRNI FLAI 1 ,FN » , XFCI I . 1 . N) .FLACI 1 .MN) ) 

CALL VECTRNI FLO! 1 .MN ) , XFC (l . 1 . N » .FLUCI I . MN» ) 

IF I .NO T.LEUU) GO 7C 1002. 

PRINT 216, MN. N , MN, IFLAC I I .FN) , I =1 .3) 

PRINT 21S. MN . N , MN , IFLQC I X .FN) , I =1 ,2 ) , 

PRINT 2 C 6 
1CC2 CONTINUE 
2 C CONTINUE 
IE CONTINUE 

IF1 .NCT.LEGU) GO TC 10C4 
PRINT .222, N .( CAI I ,N ) , 1= 1 .2 ) 

PRINT 2CE 
PRINT 22A. 

PRINT 226. 

PRINT 2 2 A , 

100A CONTINUE 

16 CONTINUE 
5 0 C C CONTINUE 

16 CCNT INUE 


I X I ( I , I ,N ) , 1 = 1 .31 
N . ( XI ( 2, I ,N > . 1=1 .3) 
I X II 3, I ,N ) , 1 = 1 .31 


n CENTER OF MASS VECTORS 
CALL UNPAC I SET ,NSET . SVA ) 
IF INSET «EQ«0) GO TC 5034 
CO l J= l.NSET 
K = SET! J) 

IF I .NUT.RBLO IK) ) CO TO 1 


C 1 31 1 400 
C12I 1500 
C121 1 600 
Cl 21 1700 
Cl 21 1800 
Cl 21 1 900 
C 1 2 1 2000 
C t 21 2 ICC 
C 1 21 2200 
Cl 21 2300 
C 1 31 2400 
Cl 21 2500 
01212600 
C 1 31 2700 
Cl 212800 
Cl 21 2900 
C 1 3 1 3000 
C 1 31 3 1 00 
C 1 21 3200 
‘ C 1213300 
C 1 31 3400 
Cl 313500 
C 1213600 
Cl 21 3700 
Cl 31 3800 
Cl 31 3900 
Cl 31 4000 
C 1 31 4 1 00 
C 1314200 
Cl 314300 
C 1 31 4400 
C 1314500 
CI3I4600 
Cl 314700 
C 1214800 
C13I490C 
Cl 21 5000 
C I 2 1 5 1 00 
Cl 215200 
031 5300 
C 1315400 
Cl 215500 
C 1 31 5600 
C 121 5700 
C1315e00 
Cl 21590 0 
Cl 316000 
Cl 31 6 1 00 
C 1 31 62C0 
0216300 
C 1216400 
0316500 
Cl 21 6600 
C l 21 6700 
Cl 21 6800 
Cl 21 6900 
Cl 21 7000 
Cl 31 7100 
C 1 2 l 7200 
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CALL VECTRN { C A ( 1 » K ) »XKC(1 • 1 • K I . C A C ( 1 . K ) ) 

IF CLEOJ )PW INT 201. K ,K ,K .CCaCC 1 ,K) , 1 = 1 . J) 

1 ,CDN T INUE 
5 0 3 A CONTINUE 

IF CLECU )FR InT 202 

c .... . . 

C . . INERTIA TENSORS 

CALL UNPACCSET.N3ET.SVI > 

IF INSET .EO.O ) GO TC 5035 
CO 1 C J=l .NSET 
K. = SET ( J) 

CALL TENTRN < XI C l . I .K> .X AC( 1 . 1 ,K> .X ICC l . I .K > ) 
IF CLEGJ IFRINT 203. C X I C C 1. I . K ) . 1 = 1 . 3 > 

‘IFCLECUJFKINT 204 . K .K .K ,K, (XICC2. I ,K» . 1 = 1 .3) 
IFCLECulFRINT 203. ( X I C ( J , 1 , K ) .1 = 1 .3) 

,IF (LgCU)FRINT 205 
1 C CONT INUE 
503.5 CONT INUE 

IF CLEOU IFRINT 202 


C . 

C 

C 


l 4 


I 3 
50 4 2 


FINGE VECTORS 

COAPtT INERTIAL PCSITICN OF CENTER UF MASS CF dOOV 

CO 14 1=1,3 

C6C I . I > = COM I ) 

IF (L EC1U )FH IN T 214.CC8CI.il. 1=1.3) 

IF (SCFCNEl J.EQ.O) GO TO 5C42 
,lT£RM = SCF(NbI) 

ITER A 2= I TERM 1 +2-PCCN { Ne l ) 

00 13 M= ITERM1 . 1 TERM2 

CALL SCLVC THAI M) . CF< 1 . V J .TEM) 

CALL VECADOC CBC 1 . 1 ) .TEA . C8C 1 . 1 ) ) 

IF CLEOUIFR INT 215. A, M 
CONTINUE 

CONT INUE .... 

CALL UNPACCSET.NSET.SVB) C- 

IF INSET .EQ.O ) GO TC' 5036 
CO 2 J-=1.NSET 
K = SETjlJ) 


JJ = JCCMK) 

CALL VGCTRN (C3C1 . K ) , XMC C 1 « 1 . J J > <C8C C 1 « K > ) 
IF CLEQU IFR INT 20 6, K . J J . X . CCBC C I .K ) . 1 = 1 • 3) 
2 CONT INUE 
50 3 € CONTINUE 

IF C L ECU ) PR INT 202 


1 


free coordinate vectors 

IFCNSVU.EQ.O) GO TC 503? 

CO 3 J = 1 . NS VO 
* : 'VaiJl ■ 

IFCFCCNCFJ.GE.O) go TO 4 
■ 1 > ■ CALL. VECTRN . C OFC l .M+ l >.X ACCl.I.FCONC M»l))COFCCl ,M + 1 I j. 

CALL VECROS CQFCC 1.M4-1 ) , CFC < T.M-1 ) ,QFCC 1 .M) I f 
CALL VECNRM CUFCCl.M)) 

IF (LEGO )Fl = w-1 

IFCLEQU )F2 = M+l 

IF CLEGU )PRINT 2C8. M .M2. A l , COFCC l .M ) . I = l . J) 

CO TC 3 

4 CALL VECTRN C OF C l . A ) , XMC C I . 1 .CCONC M ) ) , OFC C t . M I) 

IF (LEQO) PRINT 207. M , FCC N < M ) , M , C GFC C I . M ) , 1= l .3 > 

■ ' •’ ' 3 ! CC NT INUE 


C I3I7300 
C 1 31 7400 
Cl 31 7500 
Cl 31 7600 
C 1 31 7700 
C l 31 7800 
C l 31 7900 
Cl 31 8000 
C 1 31 81 00 
C l 31 e200 
C 1 31 8300 
C 1 3 1 8 40 0 
C l 31 8500 
C l 3 1 8600 
C l 2 1 87 00 
C l 31 8800 
C l 31 8900 
, C l 31 9000 

C1319100 
C 1 31 9200 
Cl 31 9300 
C l 31 9400 
Cl 219500 
0121 9600 
Cl 21 9700 
Cl 319800 
C 1 3 1 9900 
C I 320000 
C 1320 100 
C132020C 
Cl 320300 
C 1 32 0400 
C 1 320500 
C l 320600 
Cl 320700 
C 1 320800 
C 1 320900 
Cl 321 00 0 
C 1 221 100 
C l 221200 
C 1 22 1 300 
C 1 32 1400 
Cl 221500 
C 1 221 60C 
C t 221 70C 
Cl 221800 
C 1 22 1900 
C 1 222 OOC 
-C 1 222 ICO 
Cl 322200 
'll. <01 22230 C ' 
C 1 322400 
Cl 322500 
Cl 222600 
Cl 222700 
Cl 322800 
C I 322900 
C 1 323000 
C l 2231 00 
C l 323200 


n n A A A A 


£03 7 CGNTINUE 

IF ILECU IFRINT 203 

LOCKE C COORDINATE VECTORS 
IF INSVP.E0.0) GO TO 5036 
CO 5 J=I.NSVP 
L = EVP ( J) 

IF ILCCN IL > .GE .0 ) GL TO 6 
b = -LCCMLl 

CALL VSCROS (CiFCI l.M> .CFC( 1 .M+l I ,OLC( 1 .L> I 
CALL VECNRM ( QlC I 1 »L ) ) 

IFILEOUlPl = M + l 

IF ILEGU IPRINT 2C9 . L . M . M I . { QLC ( I .L > , I = 1 , 3 ) 

CO TC 5 

6 CALL VECTRN ( QL ( 1 .L ) . XMC ( l . I , LCUNt L ) ) . OLC t 1 .L ) ) 
IFILEOU IPRINT 210. L . LCO M L ) .L . ( ULC ( I , L ) . I = 1 .3 ) 

£ CONTINUE 
£036 CONTINUE 

IF ILEQU )FR INT 202 

PCINT PASS POSITION 
CALL UNPACISET .NSET.SL) 

IF INSET .EG.O ) GO TC 5039 
CO 9 KK=I *NSET 
K = SET(KK) 

CO 11 1=1.3 

I 1 TEP( I ) = CAI I .K7 

IN 1= ECF (K) 

IT 1= INI +2-PCUN (K) 

CO 12 M= IN l. IT 1 

IF ILECU }FR INT 212. K.K.P.M 

CO 12 1=1.3 

12 TEP(I) = TEM(I) *• THAI t> ) *QF < I . M) 

CALL VECTRN ITEM.XMCI 1 .1 *K) . CAC ( 1 , K ) ) 

IF (LEQU IPRINT 213. K.K.K.ICACI I.K) .1 = 1.3) 

S CONTINUE 
£039 CONTINUE 

ANGULAR MOMENTUM *FEEL 
CALL UNPACISET. NSET.SVM) 

IF INSET .EO .0 ) GO TC 5040 
CO 7 JJ=1,nSET 

j = se rt jj ) 

CALL VECTRN I HM I 1 . Jl . XMC I 1 . 1 . MO I J )) .HMC I 1 . J ) ) 

7 CONTINUE 


C 122330C 
~ C132340C 
Cl 323500 
C132360C 
C l 32 37 00 
C122360C 
Cl 323900 
C 1 324000 
Cl 324100 
C 1324200 
Cl 324300 
C 1 324400 
Cl 3245C0 
C 1 32 4 60 0 
C 1 324700 
C I 324800 
C 1 324900 
C l 325000 
C 1325100 
C 1325200 
C 1 325300 
Cl 325400 
C 1 2255C0 
C 1 325600 
Cl 325700 
Cl 325800 
C l 325900 
Cl 326000 
C 1326100 
C 1 326200 
C 1 326300 
C 1326400 
C12265CC 
C 1 32 660 0 
C 1 32 67 C 0 
Cl 326800 
C 1 32 6900 
C l 32 7000 
C 1 3271 00 
C 1 32 7200 
C 1 327300 
Cl 327400 
C 1 327500 
C I 32 7600 
C 1 32 7700 


S04C CONTINUE 

IF I .NOT . LEC1U) RETURN 
1FINSET .EQ.O ) GO TC 5041 
CO 8 J J = 1 .NSET 
J = SET 1 JJ ) 

PRINT 211. J ,MOI J > . J . I HMC I I . J) .1 = 1 . 3 ) 

6 CCNT INUE 
£041 CONTINUE 
PRINT 202 
C 
C 

2 0 C FORMAT 1*1 SUBROUTINE TRANVO ENTERED 1 .21/)) 

201 FORMAT (• C AC I * • 12 « ' ) = XMCI‘,12.*) * CAI*,I2.«) = *,3017.8) 

202 FORMATI3I/I) 

203 FORMAT I44X.3Cl7.e) 


C I 327800 
Cl 32 790 0 
Cl 328000 
C1328100 
C 1 32 820 0 
C 1 326300 
C 1 328400 
C 1 328500 
Cl 328600 
C 1 328700 
C 1 328800 
Cl 32 890 0 
Cl 329000 
C132910C 
C 1 329200 
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= XMC l*. 12,') « XI ( ■ , 12 , ' 


20 S FORMAT ( • > • ) 

2C6 FORM A T ( • CD 
2C 7 FORM A T ( • OF 
zee FORM AT ( • OF 

♦ e> 

'20 9 FORMAT ( • OL 

4 6) 

21,6 FORM FT ( * OL 

211 FORMAT I • H iV 

2 12 FORMAT ( ■ CA 

212 FORMAT 125X.* 
214 FORMAT ( ■ 03 

2 1 S FORMAT 1 • CB 

216 FORMAT (20X, • 

217 FORMAT (20X, • 

216 FORMAT 1 • 

219 FORMAT 1 • FL 
22 C FORM AT ( 20X , * 
22 1 . FORMAT 120X, ■ 

223 FORMAT <20X, ■ 

224 FORMAT ( 40X. 3 
22 E FORMAT 120X.' 
226 FORMAT 1//.25 

RE TURN 
END 


2 C 4 FORMAT <• X IC ( * i 12 • ' ) = XMCl'. 12.') « * XMC < • . I 2 . * > 4* T C 1 32930C 

,* = • .3017.8) . C122940C 

(•*•')' ^ Cl 22950C 

(• C DC 1 ' . 1 2 . • ) = XMCl • , 12. • ) • * Cot • . 12. • ) = '.2017.6) 0329600 

(• UFC 1 • . 12 . • ) • = XMCl'.I2i'> « OFl',12.') = ',3017.6) C13297CC 

<• QFC1'.I2.») = NCRMIOFC1 • . 12. • ) X OF C 1 • . I 2 . • ) ) = • . 30 1 7 . C 1 32 980C 

C 1 329900 

(• 0LCC.I2.') = NORM IUFCI • . 12 . • ) X OF Cl' ,12.')) = • . 20 I 7 . C 1 33000 C 

C 133010C 

1' OLCl',12.') = XMC (• ,12,*) * QLl',12.') = *.3017.8) C 1330200 

1 • HMC 1 • . 12. • )• = XMCl • . 12. • ) * H.Ml • , 12. * ) = .' . 1 2X.3C1 7. 6 ) Cl 33030C 

1* CA1',I2,') = CAl',12.') ,+ TmA( • . 12. • )*0F1 • . I 2. • ) •) C133040C 

<25X. *’ CACl * ,12. •) =. XMCl.* . 12. ' )«CA< •. 12. * ) = • , 2C 1 7 . 6 . 7 ) . C 1 33 050C 

1' cai 1) = '.3017.6) C133C60C 

l' Cat 1) = cat l) A TilAl • . 12, • )*0F1' . 12, ■ ) •) C123C70C 

(30X, • CAI'. 12.') = CAl',12,*) + THAI '. 12 .' >»FLAI '. 12 ..')•) Cl 330800 

l 20 X, • : XT 1 • , 12 , • ) = Xil'VI-2,') ♦- ThAl • . 12 . • )*FLE1 • , 12. • ) • ) C l 330900 

1 • ’ FL ACT • , 12 . • > = XMCl V. 12. • ) »6L At • , 12 . • ) = • . 301 2 . E > Cl 331 COC 


• ) 

CuC 1 • . 12. • ) 
OFC 1 • . 12 . • ) 


CiLC 1 ■ . 12 . • ) = 

OLC 1 • . 12. • ) = 
HMC 1 • . 12". • ) = 
CAI ',12.') = ( 


1' FCOC1 • .12,' ) = XMCl'. 12,*: 
1 2 0 X , ' CAl',12.') = CAJ1*.I2, 

1 2 0 X • ■ XU', 12,') = XIOt'.I2, 
120X, ■ , CAI'. 12.') =*.3012.5) 

1 4 0 X , 3D 12 . E ) 

1 2 0 X , ' XII', 12.') ='. 3012.5) 


XMCl ' . 12, • )*FLOt ■ . 12. • ) = 
= CAJ1 • . 12. * ) * I 

= . XIOt ■ . 12. • > • ) 


FLEXIBLE 6 CO Y PARAMETERS FOR 3U0Y 1 


C 1 231 ICC 
C 1 33 I 20 0 
C 1 331 300 
Cl 33140C 
Cl 33 1 EC C 
C 1 33 1 60C 
Cl 331 70C 
C 1 331 BOO 
C 1231900 


C C1400COC 

SUERCUT INE IRATE , , .0400100 

C . L EE C TO COMPOTE ALL LINER AND ANGULAR VELOCITY VECTUPS REQUIRED C14002CO 
C Cl 400300 

C RCMCll.O = FOR 6 COY K RIGID- ANGULAR VELOCITY OF BODY X FIXED C143D4CC 

C Axes RELATIVE TU JODY JCONlK) FIXED AXES! C 1 400500 

C , FOR 0 CD Y K PCINT MASS- UNtAk VELOCITY OF POINT MASC14C0600 

C . REALATIVE TO AXtS FIXED AT HINGE POINT K-I CI400700 

C CCMC(I.K) = FOR BODY X RIGlU- ANGULAR VELOCITY CP BODY X FIXED C1400BCO 

C AXES RELATIVE. T.O FRAME LF COMPUTATION C1 400900 

C ■ FOR BODY K PC INT MASS- EQUALS ROMCll.X) C1401C0O 

■ FCMCII.K) = FOR BODY K RIGID- ANGULAR VELOCITY OF BODY X FIXED C 1 40 I 1 00 
AXES RELATIVE TO I NERT I AL FRAME ,0401200 

- FOR BODY K POINT MASS- EQUALS RUMC11.X) C140I300 

OCMC(l.K) = SUM OF inertial OE'R I VAT I Vt S l F IR S T ) OF FREE VECTORS 0401400 

AT HINGE PCINT K-l C1401500 

implicit real*c t a -f , o-z . s i ci 4 oieoo 

, C 1401700 

> C 1 4 0 1 8 0 0 

LOGICAL : FG1 . FG2. FG3 , FG4, FG5, l NERF , . RfcJLU. LEQU, LIMTI1) C14C190C 

LOGICAL LRLNGE . LTRNSI . LVDIV . LEQUIV'. LTRAN , . J C1402000 

'.COS'*. J 3 , lot! LiTRANV . LfjAJf , a lXUY . LETA . L T OR GU . CI402I00 

* lofdut , ldct ,-langle ,-lsetup . lsimo 0492200 

Cl 4023C0 
C 1 402400 

INTEGER , . C14C250C 

* AXCRX . CT1 . CT2 , CT3 . CT4 . C T 5 . FCCN PCCN . C14026CC 

* SCNCUM. SON . SCRDUM, SCR . SFKUUM. SFX . SF R ■ , ' SG . C14C2700 
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S l 

• S Io 

• S1XDUM 

.six . 

SKDU* 

. SK 

. SL 

. SLK 

• 

C 1 4028 OC 



S*«A 

. SMCDUM 

• SVC 

• SMV , 

SOK 

. SPIDUM 

. SPI 

• SQF 

• 

C 1 402900 



SCL 

. SK 

t SSCN 

. S £ IX . 

SVA 

. SVb 

. SVD 

. SV I 

• 

C l 403C00 



SVM 

. SVP 

. £ VO 

. sxw , 

SXT 

. TOFU 

• SMAL 

. seu 

• 

0403100 



SC 

. 5CG 

. NFLX9 

. SFLX , 

SFXM 

. NMCOS 

. SFCC 

. see 


C 1 403200 



I IN IT( 

1 ) 

. I Z I N I T ( 1 ) , 

SD 





Cl 403300 

c 











04)3400 

c 






, 





C1403SOO 

c 











C 1 403600 



peal «e 









C 1 403700 


* 

ANGC 

(S3) 

• CNF 

(3.10) . 

ETIC 

(3.10 

. E T MC 

(3.10). 

• 

C l 403.800 


* 

FLO 

( 3.20 ) 

• FLE 

( 3.3.20) , 

flh 

(3.3.20) 

• 



C 1 403900 


* 

TF ACO 

C 33 » 

. Y VCD 

(3.2.11 ) . 

RINIT 

( 1 >: . 

. KZINlT(l) 


C 1.4 0 400 C 

c 











C1404100 

c 











C 1 404200 



CCMMCN 

/LDE8UG/ 

L RING E 

. LTRNS1 

. LVDIV 

• LEO 0 I V LTRAN , 


Cl 4043CC 


* 



ltkanv 

. LP ATE 

. LXDY 

• LETA 

L.TORQU 


C 1 40440C 


* 



LCFDOT 

. LOCT 

LANGLE . LSLTUP , LS1MQ 


Cl 404500 

c 











C l 404 60 0 

c 











Cl 404700 



CL) VMCN 

✓LUGI C/ 

FG1* FG2 

• F G 3 • F G 4 * F G S . 

I NEFF., 

«BLO( 10) 



C 1404800 

c 











C 1 4C4900 

c 











. C 1 40500C 

. 


COMMCN 

/ I NT G / AW G R K { 200) t 






Cl 4051 OC 



C T1 


. CT2 


CT3 


t CT 4 


• 

C 1 4052C0 



C T5 


» FCON 

< 33) 

JCC N 

( 1 0) 

• LCCN 

(22 ) 

* 

C 1 4053C0 



MC 

I 10) 

• N01 


NdUD 

j 

• NC re 


t 

Cl 4054CC 



NFEP 


• NFKC 


NFRC 


• NL OR 


t 

C 1 405500 



NM V 


• NMG 


N M J A 


. NS VP 


• 

Cl 405600 



NSVC 


• FCON 

(11) 

SD 


. SFR 

( 33 ) 

• 

Cl 405700 



SG 


• SI 

( S5 ) . 

SIG 


• Sl 


• 

C 1 40580C 



SLK 

( 33) 

• $MA 

( 10 ) . 

SCK 

(11) 

* SUF 

(11) 

• 

C 1 4 059 CO 



SCL 

(11) 

» SM V 


SR 


• SSCN 


• 

C 1 406000 



SS I X 


. SVA 


SVt* 


« SVD 


♦ 

C 1 406100 



svi 


. SVM 


SVP 

(22) 

t SVQ 

(33.) .1 


C 1 406200 



S XM 

< 3. 10 ) 

t SXT 


TUFQ 

(97) 

.. SMAL 

• ‘■it; , 

• 

Cl 406300 



seu 


• NTQ- 


SC 

( 33) 

t SC G 


• 

Cl 4 064 CO 



nfl xa 


t ! SFLX 


SFXM 

(10) 

• NMODS 


• 

Cl 406500 



SFCC 

r 

f see 

(10) 






C 1 4C660C 

c 











Cl 406700 

c 











C 1 406800 


CCMMC N 

/ INTGZ/ 

’ 







C 1 406900 



SCNCLM 


. SCN 

(9) . 

SCRDUM 


• SCR 

(9) 

• 

Cl 407000 


* 

SFKCUM 


• SFK 

( 9 ) 

S IXDJM 


• SIX 

( 9 ) 

1 

C 1 40 7 100 


♦ 

SKDLM 


t SK 

(9) 

SP I DOM 


• SPI 

(9 ) 

• 

C 1407200 


* 

ShCCLM 


. SMC 

(9) 


, 




C 1 407300 

c 











C 1 407400 

c 











C 1 4C7500 



CChMC N 

/PEAL/ 








C 1 4C7600 


♦ 

C A 

(3.10) 

• C AC 

(3.10) . 

ClM 

( 10) 

• CCMC 

(3.11) 


C 1407700 


* 

.CCMC 

(3.11) 

. ETC 

(3.11) 

ETM 

( 33) ' 

• FL MC 

(3.11) 


Cl 407800 


* 

GAM 

(3.66) 

• h 

• 

HM 

( J. 1 0 > 

• HMC 

(3.10) 


Cl 407900 


* 

HMC M 

( 10) 

• Phi 

(3.11) . 

plm 

(10) 

• OF 

(3.33) 


C14C8000 


* 

. QFC 

13.33) 

• QL 

( 3.22 ) , 

QLC 

(3.22 ) 

. ROMC 

(3.11) . 


C 1.408 IOC 

oo sr 

9* To 

’ • - « t 

• >f 

i 

J THA* 

(3 fj>)J „ 

*TH 'A D 

( 33) 


C 1408200 


* 

THACW 

(10) 

\ thaw"' 

( ic ) 

' XDIC 

( 3 * 3,66) 

• XI 

(3.3,10 


C 1408300 


♦ 

X IC 

(3.3,10) 

« *MA S 

(10) . 

XMN 

(33.33) 

♦ XMT 

(3,3.10 


ci4oe4co. 


* 

TCG 

(33) 

• FLA 

(3.20) , 

FLo 

(3,20 ) 

. flc 

(3.20 


Cl 408500, 


* 

FLO 

(3.3.20) 

• FLJ 

( 3.3 .20 ) . 

CAU 

(3,10) 

• XIO 

( 3.3 .10) 


C 1 408600 


♦ 

FL IRC 

(3.10) 

. flcrc 

(3.10 . 

FLAC 

( 3 .20 ) 

. flqc 

(3.20) 


C 1408700 











• 
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* FLC V ( 20 ) 

* TIMEND 

. ZETA 

(20 , 

FCF (3,3 .40 ) . FCK 

( 3.40 ) 

CCNMCN /^EAl _Z/ 

*• CBDLM ( 1 • J ) 

. CE 

(3.10 

CdCiJUM (1*3) • C6C 

(3.10) 

* XK'CCLM ( 1 • 1 t 9 ) 

• x*c 

(3.3.10). 

C dN ( J ) 



c 

EQUIVALENCE ( £ TM < I ) . Trt AC C ( t J ) 

* ( XMN ( 1 .3 ) . YMCD( 1 ,1 , 1 ) ) 

* ( X MN ( 1 .8 ) . ET IC < 1 . 1 ) ) 

* (FlBU.I) ,FLC( 1.1)1 

* ( FLH ( 1.1 .1 ) . EL J < 1 . I . 1 ) ) 

* (FG1 .LIN I TC 1 )) 

„* (CtiuuM(t.n.EziMru)i 

* ( SCNDLN »1ZINIT(1)) 

CIWENSICN XI (3) .X2(3 ) 

CIMENSILN TE Ml ( 33 ) .T£M2< 23 ) 

REAL*8 EFCM C(33). ECCMCC33). ERCMC<33>. cOLMC(33) 

IN TEC-LW SET (10) 

LOCICAu CTAIN 
C 

C LSE SINGLE DIMENS ICN ARRAYS »H£N ADVANTAGEOUS TU INCREASE 

c ccmfltaiign speec 

EQLIVAlENCE<FCMC<1.1>.TEMI<1>) . (CCMCI 1 . I ) . TEM2( 1 ) ) 
EQUIVALENCE < EFGNC ( 1 ) . FCKC < 1 . 1 ) ) . ( ECJMC ( 1 ) , COMLI 1 , 1 ) ) . 

* (EfiCMC (1 > .PCMC II .1 > ) , (ED CMC < 1 ) , DOMC ( 1 , l > > 

C ■ 

equivalence (lrate.lEqc) 


IF (CEGU )FK InT 200 
IF ( .NUT .Lfc'OU > GU TO 10CC 
IF ( I NERF ) Gu TO 3 3 
fKIM 201 
GO TC JA 
. 33 PRINT 2C2 

34 CONTINUE 

C EVALCTE RELATIVE VELOCITY VECTURS 

103C CONTINUE 
V = 1 

CO 1 K= 1.NB1 
IF(K.EG.l) GC TO 2 
N = NF3-FCON ( K — 1 ) 

2 CO NT IN U E 
I K 1 = 34K-3 

CC 3 1 1 = 1 . 3 

IK = IK HI 

• 3 1- ERCM C (IK) = 0.00 

IF (LEGU)FRINT 221 . k 
IK = IK 1 +1 
•ITERN = MF2-PCCN(K) 

IF ( M .GT . I TERM) GO TG 1 

I'-EO 3 M Ni = N • I T€EV f.y A :i R3TF.30 OHA 2 RD T A J J 1 3 2 O Ra-U-M ' =' NMAj 

CALL S CL V ( THAO (MM ) ,QFC( 1 .KM), XI ) 

CALL VE C ADD( X I .ERCNC ( I K ) .ERCMC ( I K) ) 

IF (LECU (PRINT ,20S . K.K.NN.MM 
:• CONTINUE 
1 CONTINUE 


. ( XMN (1.1), AN GDC I ) ) . 

. (XMN( 1.6) .CNF ( 1. 1 ) ) , 

. ( XMN( 1 . 10 ) ,ETMC< 1 . 1 > > , 

. (FLL ( 1 .1 . L) , FLL ( 1 . 1 . 1 ) ) , 
• 

. (CA( 1 , 1 ) ,R INI T ( 1 ) ) 

, (AKufiKC I ) , IINITC I I ) , 


. ciAoeeco 

C 1 406900 
C 1 409000 
C 1 409100 
C 1 409200 
. C140930C 

C 1 4 094 00 
Cl 409500 
C 1 409600 
Cl 4C97C0 
Cl 409800 
C 1 409900 
C 1 410000 
041 0100 
C 141020C 
Cl 41 0300 
041 0400 
C 1410500 
C 1 41 060C 
0410700 
Cl 41 0800 
0 41 090C 
Cl 41 1000 
C 141 1 100 
041 1200 
0 411 30C 
Cl 41 1 400 
Cl 41 1500 
Cl 41 1 600 
0 411 700 

c i 41 i eoc 

0 41 1900 
Cl 41 200C 
0 41 2 IOC 
C 1 41 2200 
Cl 412 300 
C 1412400 
C 1 41 2500 
Cl 41 2600 
0412700 
01 41 2800 
0412900 
C 1413000 
0413100 
C 141 320C 
C 1 41 330C 
0 41 3400 
C 141 3500 
C I 41 3600 
041 370C 
Cl 41 3800 
Cl 41 3900 
Cl 41 4000 
0414100 
3 *C 1 41 4200 
C 1 41 4300 
041 4400 
C 1 414500 
0414600 
C 1 414700 
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2 S 

10 0 1 

c 


c 


7 


e 

504 2 


9 


1 c 

£0 A 3 


c 

c 

1 1 
l 3 


26 

10 0 2 

1 2 
C 

gosc. It 


IF ( . NCT .LEGU ) GO TC 10C1 
PRINT 2 1 A 
CC 2S K - 1 * Nd 1 

PRINT 21S. K ilKOMCI J .K ) .J=l .3) 

PRINT 21 A 
CON T I N uE 

EVILufTt ANGULAR VELCCITY BODY K TO 

TAKE CARE UP EIG1C BODY ANGULAR RATES 
CALL LNPACISET ,NS£T, SR > 

CC 7 1= 1.3 

FC-MC (1.1) = RGMCl I . 1 ) 

IP (LEGO ) PRINT 219 
NSiETM = NSET - 1 
IP (NSETMl. Eu.O) GO TO ECA2 
CC e JJ- 1 .NSETMl 
J = NSE TP 1 - ( J J- 1 ) 

k = se r i j ) 

CALL VECADOI FGMC ( 1 . J CC N ( K ) ) , RCMCl 1 . K ) 
IFILEGUlJK = JCCN(K) 

IP (LEJUI PRINT 209. K.JK.K 
CONT IN JE 
CONT INLC 

IF ( l NcRF > GO TO 11 

CC 9 I = 1 . J 

ECCMC ( l ) = 0 .CC 

IP (LEGU (PRINT 21 A 

IF (LECL 1FR INT 222 

NSETMl = NSET - 1 

IF (NSETM 1 . Eu .0) GO TO S0A3 

CO 1C JJ = 1 . NSETMl 

J = NSETMl - ( JJ - 1 ) 

* = SET! J) 

CALL VSCAOOI CO MCI 1 , JCCM K) ) .FOMCI l.K) 
IP (L EOU ) JK = JCOMK) 

IF (LECU (PRINT 210, K.JK.K 
CONT INUE 
CONT 1 NU G 

IF (LEGU (PR INT 21A 

GU TC 12 


C 1 A1 A800 
C 1 A1 A900 
Cl A 1 50 CC 
C 1 At 51 00 
C 1 A1 5200 
Cl A153C0 
C 1 A1 5 AOO 

inertial and computing fr amec i ai 5500 

Cl Al 56C0 
C 1 Al 5700 
Cl Al 5800 
C 1 Al 5900 
C 1 Al 6000 
CIA16100 
C 1 Al 62 OC 
Cl A 1 6300 
C 1 Al 6A00 
Cl Al 6500 
Cl Al 6600 
C l 41 6700 
Cl 41 6800 
Cl Al 6900 
Cl Al 7000 
Cl Al 71 CO 
Cl Al 7200 
Cl Al 7300 
Cl Al 7 A 0 0 
C 1 Al 7500 
Cl Al 760C 
C 1 Al 7700 
Cl Al 7800 
Cl Al 7900 
C 1 Al 8000 
C 1 Al 8100 
Cl Al 82 OC 
Cl Al 8300 
Cl Al 8A00 
Cl Al 8500 
C 1 Al 8600 
Cl Al 8700 
Cl A 1 8800 
Cl Al 8900 
C 1 A19000 
C 141910C 
C 1 Al 9200 
C 1 Al 9300 
C 1 Al 9400 
Cl Al 9500 
C 1 Al 9600 
C 1 Al 9700 
Cl A1980C 
Cl Al 9900 
C 1 A20000 
CI420100 
C 1 42 0200 
C 1 420300 
C 1 42 0 AO 0 
C 1420500 
Cl 420600 
Cl 420700 


.r'CMCI l.K) ) 


, CUMCI l.K)) 


CCMC = FCMC via equivalence for inertial computing frame 
ITERM - 2 * N8QD 
CC 1: l = 1. ITERM 
TE M 2 ( 1 ) = TEM1 ( I ) 

IF (. NOT .LEGU ) GO TO l 0 C 2 
PRINT 21A 
CO 2( K = 1 ,N80D 
PR INT 22C. k,K 

PR IN T 2 I A ... 

CONT INUE 
CONT INUE 

T/iKE CARE UF LINEAR OSCILLATORS AND CENTER CF MASS MOTION 
CALL ONPACISET .NSET, SL ) 

IF (N'ET .EG. 0 ) GU TC SOCC 
CO 2 3 J= 1 .NSET 
K = SET ( J ) 

IF (LEGU 1 PRINT 223 . K.JCCN(K) 
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IF(L£0U) PRINT 224, K.JCCMK) 

CO 6 i=l.J 

' . FOMCCI.K) = FOKCI I.JCCMKl) 

6 CCMC(I.K) = COMC ( I . JCON < K 1 1 
22 CONTINUE 
SO C C CONTINUE 

FCMCCl.NEl) = KOMCU.NEll 
IS CCMC(I.NEl) = ROMC(I.NEl) 

IF(LEOU) PRINT 2CE. NH1 • Nt2 I *N3 l 
C 

IF ( iNuT .LEGU > GO TC 10C2 
- CO 26 K-1.NB1 

26 PRINT 217. K . ( COMC < J ,K ) . j= 1 .3) .K . (F CMC I J . K) . J= 1 .3 ) 

PRINT 214 
1 0 C 2 CONTINUE 
C 

C . : EVALLTE COMPONENT S CF ACCELERATION ASSOCIATED *ITH CGOPOINATE 

C • FRAME ROTATION 

C 

IF (CT4 .NE. 1 ) GO TO IS 
CO IS »*l»NUl' 

IK = 2*K-j 

CO 14 1=1. J 

IK = IK+1 

14 EOCMC(IN) = 0.00 
, . IF (LEuiU >PR INT 212, K 
1 E CO N T INUE 

. CYCLE THROUGH. ALL ECDIES 
m = l 

CO 16 K— 1 , N8CD 
,IK 1 = 2*K-3 

IF (LECL )FR IN T 203 
;■ IFIK.Ea.il M TO 17 
V = t F3-I5CCN (K-l 1 
17 IF C . NUT .RdLG <K 1 ) GO TO 16 
CO 2 1 1=1,3 

IK = I K 1 ♦ 1 


Cl 42 C800 
Cl 420900 
Cl 42 1000 
C 1421 IOC 
C 1 42 1 200 
Cl 42 1 300 
C 1 42 1 400 
C 1 42 1 500 
C 1 42 l 600 
C 1 42 1700 
C 1 42 1 800 
Cl 421 900 
C l 422000 
01422100 
C 1422200 
C 1 422300 
C 1 422400 
C 1422500 
C 1 422600 
Cl 42270C 
Cl 422300 
C 1 422900 
01423000 
C 1 423100 
C 1423200 
Cl 42 33 CC 
Cl 423400 
C 1 423500 
Cl 423600 
C 1 423700 
C I 423800 
Cl 423900 
C 1 424000 
C l 424 1 00 
C 1424200 
C 1424 300 
C 1 424400 
Cl 424500 


2 1 EDCMC < IK 1 = 0.00 

IF (LtClU 1 PR IN T 212. K 

C TAKE CARE OF COMPONENT CLE TO ROTATION OF FRAME K RELATIVE TO 

C CYCLE THROUGH FREE COORCINA1E VECTORS AT HINGE POINT K-l 

IK = I K 1 * 1 

MMM = M ♦ 2 - PCOMK) 

IFIM.GT .MMM) go TC 5044 
CO 16 M N = M. MMM 
MF = FCCN(MM) 

IFIMF.LT.01 GO TO 18 
IFIMF.EG.31 GO TO 16 

CALL VlCRGS (FCMC ( 1 , MF ) , GFC { 1 . MM 1 . XI 1 
CALL SCL VI TH AD 1 MM ) .X 1 . XI 1 
- . CALL VSCADOI ECCMC < IK) .XI .EDOMC1 IK) ) 

.. IF (LEOU 1FRIN T 213. K.K.MM.MF.MM . 

CO TC 16 

-. 0 l.e 0 KF 5 = fCCMRM-l) 

Ml .= MM — 1 

CALL SCLVl TH AO (MI 1 ,OFC C 1 .Ml ).X 1 1 

.IF (MF .EG. 01 GO TO 4 

CALL VCCAOOIFOMCI I .MF 1 .XI. XI) 

4 CONT INUE 


C I 42 4 60 0 
C 1 42470C 
I NER C l 424800 
C 1 424900 
Cl 425000 
Cl 4251 00 
C 1 425200 
C 1 425300 
C 1 42540C 
C 1 425500 
Cl 425600 
C 1 4257C0 
C I 4258C0 
Cl 425900 • 
C 1 42600C 
C 1 426 100 
C 1 426200 
Cl 426300 7 
C 1426400 
Cl 426500 
C 1 426600 
C 1 426700 
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CALL VECROS IXl.QFCCl .KMI.Xc) 

CALL SCLV< THADIMM ) .X2.X2 I 

CALL VECADD(ECCMCIIK>,X2.SDCMC11K)) 

IF IMF. £0.0) GO TO 5 

IFlLEOU )FRINT 21 6, K . K . »l> . »F .Ml . Ml .KM 
CO TC It 
5 CONTINUE 

.IF ILEGU 1PH1NT 204 , K . K , MN . M 1 , M 1 . MM 
5044 CONTINUE 
It CONTINUE 

IF { . NOT .LEUU I RETURN 
PRINT 214 
CO 2S X = 1 ,NB1 

25 PRINT 227. M . ( DuMC ( J , M I , j = 1 , 3 ) 


20C 
20 1 
2C 2 


FORMAT 

FORMAT 

FORMAT 


1 • 

( / . 
( /. 


SUBROLT I NE 
CCMPLT ING 
CCMPLT I NG 


RATE ENTc 
FRAME 15 
FRAME 15 


RED • > 

BODY 1 • ./ ) 

INERTIALLY FIXED 


. ✓ ) 


Cl 426800 
C 1 426900 
C l 42 7000 
C 1 42 7100 
C 1427200 
C 1 427300 
Cl 427400 
Cl 42 7500 
C1427600 
C ! 42 7700 
Cl 427800 
C l 42 7900 
C 1 428000 
C 1 426100 
C 1 428200 
Cl 428300 
C 1 42 8 400 
Cl 428500 
Cl 42e600 


2 C 3 

FO RM AT 

i • 

• ) 












Cl 428700 

204 

FO PM 4 T 

( • 

DCMC < 

• . 12 . • > 

= 

DCMCI • .12. •) 

■f 

THADl 

• 

• 

12, 

• 

)*THACI • . 12 

• 

• ) Cl 428800 


* *0FC ( » . 

12. 

• ) X QFC{ • » 12 

- I 

) ■ ) 









Cl 428900 

20 5 

FORM AT 

( • 

RCMC ( 

• . 12 . • ) 

= 

RCMCI • . 12. * 1 

♦ 

THADI 

• 

• 

12. 

■ 

)*GFCt • . 12, 

« 

) C 1 429000 


* • ) 














C 1 429 100 

2 oe 

FORMA r 

( • 

FCMC ( 

• .12. • ) 

= 

CCMCI • . 12 . • ) 


RCMC I 

• 

» 

12 . 

• 

) • > 


C 1 429200 

209 

FOPM A T 

( • 

FCMCI 

■ . 12. • ) 

= 

FCMCI * . 12. • ) 

♦ 

RCMCI 

• 

• 

12. 

• 

> • ) 


C 1 429300 

210 

FCRMAT 

l 1 

COMC ( 

• . 12 . • ) 

= 

CCMCI • . 12. • ) 

♦ 

ROMCI 

1 

• 

12. 

• 

> • ) 


C 1 429400 

2 1.2 

FORM A T 

l • 

DOMCI 

• . 12 . • ) 

= 

0 • > 









Cl 429500 

2 13 

FORMAT 

( • 

DOMC ( 

• .12. 1 ) 


CCMCI • . 12, • ) 

♦ 

THADI 

1 

• 

12 . 

• 

)*IFCMCI • .1 

2 

.•Cl 429600 


* » X CFC ( • . 

12 . • 1) 

• ) 











Cl 429700 

2 14 

FCFM AT ( 

2 17) ) 












Cl 429800 

2 1 5 

FORM AT 

< • 

KCMCI 

• . 12. • ) 

- 

• .3017.8) 









C 1429900 

216 

FORMAT 

( • 

D CMC ( 

• . 12 , • ) 

•= 

CCMC I < . I 2. • > 

♦ 

THADI 

• 

• 

12. 

• 

)*T I FCMCI • . 

t 

2. Cl 430000 


*•) ♦ TMADI 

• . 12 . • 

) »QFC I ■ 

. 12. • ) ) X OF C 1 * 

. 12 

. • > ) • 

) 






C 1430100 

217 

FORM A T 

( • 

CCMCI 

• .12. • ) 

= 

• .301 7.8. * 

FOMC I • . 12 

• 

• ) 

= 

• . 3D1 7 .6 ) 


C 1 43020C 

21 5 

FORMAT 

l • 

FCMCI 

1) = RC MCI 1 J • ) 







• fc. m 


Cl 430300 

22 C 

FORMAT 

( • 

CCMCI 

• . 12. • > 

= 

FCMCI < . 12, • > 

• > 








C 1 430400 

22 1 

FOFMAT 

( * 

KCMCI 

* , 12 . • 1 

= 

0 • 1 









Cl 430500 

222 

FORMAT 

( • 

CCMCI 

1 ) = C 

• 

I 









C 1 430600 

22 2 

FORMAT 

< * 

FOMC I 

• . 12 . * J 

= 

FCMCI * . 12, ' » 

* 1 








Cl 430700 

224 

FORMAT 

I •' 

CCMCI 

• . 12 , • ) 

= 

CCMCI • , 12 , • ) 

■ ) 






• 


Cl 430800 

22 7 

FORMAT 

( • 

DOMCI 

• . 12 . • ) 

= 

• .3017.8) 









Cl 430900 


RETURN 

ENC 


C 1 43 1 000 
C 1 431 100 


1 \i M ' l 


/ , j v I i 


•SUBROUTINE XDY 

COMPUTES VALUES CF VECTORS AND DYADS USED TO DEFINE SYSTEM 
TENSOR MATRIX 


' > > ■> 

let: 


! 


GAMll.KL) = CCMFONENTS CF VECTOR FROM HINGE PCINT K-l TO TEE 
CENTER CF MASS OF EODY LAMBA W HERE 
KL = KTOlNdOD+l ,K-1 .LAMBA) 

XD1CI1.J.KI) = CCMPGNENTS OF TENSCR OF RANK T MO IN ROM K, CCL I 
CF THE SYSTEM MATRIX UF INERTIA TENSORS 


Cl SOOOOO 
CUE 00 100 
INERT C 1 5002C0 
Cl E00300 
■ ' Cl E00400 
C 1 500500 
C l 50 C 6 00 
Cl 500700 
Cl 50C800 
Cl EC09C0 
C1501000 
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KT1 (Naoo+1 . k, I ) 


t»t-ERE 


K I = 


NO TE i 


THE SYSTEM matrix of INERTIA TENSORS 
LG*ER TR1ANGLLAR PCFT1CN COMPUTED 


IS SYMMETRIC THUS ONLY 


IMPLICIT KEAL«el A-H.C-2 

. 1 1 





LOGICAL 

FGl . 

FG2. FG3 , 

FG4 ■ FG5 

9 I NcRF » kBLG 9 

LEUU, LlNIT(l) 

LCG I CAL 


LFLNGF. 

, LTRNSI 

. LVDIV . LEUUIV , LTFAN . 

I 

- 

L TF ANV 

. LR ATE 

, L.XDV • LET A 


, ltorqu . 

( 


LOFOOT 

. LDCT 

. L ANGLE . LSETUP • LSI MU 

1NTECER 








1 A*CR< 

. CT1 

. CT2 

. CT3 . 

CT4 « CT 5 

9 

FCCN 

. PCCN 

' SCNCUM 

. SCN 

, £CRDUM 

. SCR , 

SFKDUK, SFK 

• 

SFR 

. SG 

‘SI 

• S lo 

. SIXOUM 

.SIX . 

SKDUM , SN 

t 

SL 

. SL K 

• SMA 

• SMCDUM. SMC 

. SMV . 

SUK . SPIDUM 

1* 

SPl 

, SQF 

t SCL 

• SR 

. SSCN 

. S £ I X , 

SVA . SVb 

» 

SVD 

. SV I 

SVM 

. SVP 

, £ YU 

, SXM , 

SXT . TOFU 

• 

SMAL 

. SEU 

‘ SC 

• SCG 

, NFLXB 

. SFLX , 

SFXM . N MODS 

• 

SFCC 

. see 

' I IN ITC 1 ) 

. IZINIT 

( 1 > 

SO 




R6*L «d 








l angc 

(23) 

. CNF 

(3.10 

E TIC (3.10) 

• 

ETMC 

(2.10) 

' F.L Q 

( 2.20 ) 

. fle 

( 2.3,23 ) . 

FLH (3.3,20 > 

t 



1 TFACD 

( 23) 

, YMCD 

(3.2.11 1 . 

RINIT (1) 

* 

RZIN IT ( 1 ) 

CCNMCN 

/LDEUUG/ LRLNGE 

, LTRNSI 

, LVDIV Lb QU IV 

' , LTRAN . 



LTRANV 

, LR ATE 

, LXOY , LETA 


, LTCFOU . 

i 


L CFO C T 

. LDCT 

, LANGlE ■, LSETUP , LSI MO 

CCJVMCfv 

/LOGI C/ 

FGl, FG2 

• Fo3» Fv *5* INERF# 

KELG (10) 

CCMMCN 

✓ IN TG/ 

AwORK ( 20 C ) , 





CT1 


• CT2 

• 

CT J 


CT A 


CT5 


. FCGN 

( 22 ) 

JCCN (10) 


LCCN 

(22) 

wc 

( 10 > 

, NE1 

t 

N3UD 


NC TC 


NFEP 


• NFKC 

• 

NFKC 


NLOR 


NVV 


• N MG . 

• 

NMOA 


N S VP 


N SVC 


• R CO N 

(11) 

SC 


SFR 

(33 ) 

sc 


. S I 

( £5 ) . 

S IG 


SL 


StK 

I 231 

* SMA 

(10) 

SGK ( 1 l ) 


5CF 

(11) 

SCL 

(11) 

• s*v 


SR 


SSCN 


SS I > 


• SVA 

f 

S V t3 


SVD 


SVI 


• SVM 

• 

SVP (22) 


SVG 

( 33 ) 

S^'XM 

(2,10) 

. 5 XT 

• 

TORO (97) 


SMAL 


S6U 


• N TO 

• 

SC (J3) 


SCG 


NFLXB 


• SFL X 

• 

SFXM (10) 


NMCDS 


' S’FCC ' 

( 5 h «f . . 

•4^ c i 3(7 1 V U « X I T AM A I T R 3 4 1 TO 

2 if 3R 

32UHT — 

CCMMC h. 

/ IN TG Z/ 







scnclm 


• SCN 

(91 . 

SCRDUM 

■ 

SCR 

(9) 

SFKCLM 


. SFK 

(9) 

S I XDUM 

• 

SIX 

(9) 


C1EOI ICO 
C1E01200 
C 1 EOl 300 
C 1 £0 1.400 

cieoisoo 
Cl 501600 
C 1501700 
cisoieco 

Cl £01 900 
C 1EC20C0 
C 1 £02 1 00 
Cl £02200 
Cl £02300 
C 1E02400 
C 1 £02500 
C 1 £02600 
C 1 50270C 
C 1 £02800 
Cl 502900 
C 1 £03000 
C 150310C 
C 1 503200 
Cl 503300 
Cl £03400 
C l 503500 
Cl £03600 
C 1 £037 00 
Cl £03800 
C 1503900 
Cl £04000 
C 1 £CA 100 
C 1 £04200 
Cl £04300 
C 1 £ 044 CO 
Cl £04500 
C.l E046C0 
C 1 £04 700 
C 1 £04800 
C 1 5C4900 
Cl £05000 
Cl 505100 
C 1505200 
Cl £05300 
C1EC5400 
Cl £05500 
C 1 £05600 
C l 505700 
C 1 505800 
Cl 5C590C 
C 1 E060CC 
C 1506100 
C 1506200 
C 1 E062C0 
C 1 £06400 
' C1 5065C0 1 
Cl 506600 
C 1 £06700 
Cl E068C0 
C 1 EC69C0 
C 1 £07000 
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r> n 



♦ 

SKDLM 


• 

SK 

(9) 

• 

SPIDUM 


• 

SPI 

(9 ) 

• 

Cl 507 ICC 


. * 

SfrCCCM 


• 

s*c 

(9) 








• C 1 5072 00 

c 














C 1 507300 

c 














C 1 507400 


CCVMCN 

✓REAL/ 











C 1 507500 


. . * 

C fi 

(3.10) 


CAC 

(3.10) 


CLM 

( 10 ) 


CC MC 

(3.11) 


Cl 507600 


4 

DC MC 

(3.11) 


ETC 

(3.11) 


ETM 

( 33) 


FC MC 

(3.11) 


C l 5C77C0 



G AM 

(3.66) 


h 



HM 

(3.10) 


HMC 

(3.10) 


C 1 507800 

.. 


h*C * 

( 10 ) 


PHI 

(3.11) 


PL M 

( 10 ) 


CF: 

(3,33 ) 


C 1 5C7900 



QFC 

(3.33) 


CL 

(3.22) 


•ULC 

( 3.22 > 


H CMC 

(3.11) 


C 1 508000 



T 






THA 

( 33) 


THAD 

(33) 


C 1 5C8 ICO 



■THACW 

( 10 ) 


ThA* 

( 10 ) 


XDIC 

(3*3 . 06 ) 


XI 

(3,3.10 


C 1 5C82C0 

- 


X IC 

(3.3,10) 


XMAS 

( 10 ) 


XMN ‘ 

(33.33) 


XMT 

(3.3.10 


C 1508300 



T LG 

( 33) 


FLA 

(3.20) 


FLd 

(3.20) 


FLC 

(3.20) 


C 1508400 



FLD 

(3.3.20) 


FL J 

(3.3.20) 


CAU 

(3.10) 


XIU 

(3.3.10 


C 1 50850C 



FLIRC 

(3.10) 


FLCRC 

(3.10 


FLAC 

(3.20) 


FLQC 

(3.20) 


C 1 508600 



FLO 

( 20) 


ZETA 

( 20 ) 


F CF 

( 3.3 .40 ) 


FCK 

( 3.40 ) 


C 1 5C8700 


, * T IM END 


COMMON /REALZ/ 

* CEO LM ( 1, 3) 

* XVCCLM (1.1.9) 


ce 

XMC 


( 3 , 

< 3, 


1C) , 

3.10), 


cbcdumi i.3> 
CBN( 3 ) 


CBC 


(3,10) 


equivalence 


( E TM ( 1 ) ,THACC( 1 )) 

( XMN( 1.3). YMCC (1.1,1)) 

( XMN ( 1 ,8 ) . E T 1C ( 1 . 1 ) ) 

( FLB ( 1.1) • FLG( 1,1)) 
(FLH( 1 . 1 . 1 ) ,FL J( 1 . 1 . 1 ) ) 
(FG1 .LINIT(1 )) 

(CBDUM( 1 . 1 ) . RZ IN IT( l > ) 
(SCNDUV , I Z INI T ( 1 ) ) 


. ( XMN (1,1). AIMED! 1 > ) . 

. (XMN( 1 .6 ) ,CNF ( 1, 1 ) ) , 

» ( XMN ( 1 . 10) »ETMC( 1 • 1 > > . 

• <FlE (1,1,1) .FLO (1.1.1)). 
» 

. (CA( 1 , 1 > .RINIT ( 1 ) ) . 

. (A * L)F K ( 1 ) , UNIT ( 1 ) ) . 


-2 l 


INTEGER ST 1 ( 10).ST2(10).ST3(1C) , ST4 (10) 

CIUEES! CN TEM<3> , TEMt (3 ,3) . TEM2( 3 . 3 ) . TEM3( 3 ) . TfcM4 ( 3 . 3 ) 
EQL I VALENCE (LXUY.LEQU) 


IF(LECU)FRINT 228 
IF ( C 1 4 « N'E . 1 ) GO TC 20 

FIRST PASS THRUUGH PUT FULL SETS IN DECREASING 
CEDER CF MAGNITUCfc 
CO 21 K=l,NBOD 
ST 3 ( K ) = NB 1 — K 

ST41K) = Ndl-K 
NS T 3 = NECJO 
NST4 = NEOD 
CO TC 22 


C ■ ' , 

Qoeao; 

C '■ 

c 

c - 


JO SXT - THOSE R0»S OF INERTIA MATRIX, OVER> iT,C 01A;6CNAL. WHICF 
ARE TIME VARYING ANC MUST HE RECALCULATED 

■ SVO - THOSE EOCIES IN AHICH BODY FIXED VECTORS AND DYACS />RE 
TIME VARYING IN COMPUTING FRAME 


2C CALL UNPAC(ST3 .NST3.SXT) 


C 1 E0B800 
C 1 SC8900 
01509000 
C 1 £09 1 00 
C 1 509200 
Cl 509300 
C 1 509400 
Cl 509500 
C 1 509600 
C 1 509700 
Cl 509800 
C 1 509900 
C 1 51 OOCO 
C 1510100 
C1510200 
C 1 510300 
C 151 04 C 0 
C 151 0500 
C l 51 0600 
C 1 51 0700 
C l 5 1 0800 
C 1510900 
Cl 51 1 CCO 
C 1 51 1 1 00 
C 1 51 1200 
01 51 1 300 
C 1 51 1400 
C 1 5 1 1500 
C 1 5 1 1600 
C 151 1700 
C 1 51 1800 
Cl 51 1900 
C 1512000 
C 1512100 
C 1 51 2200 
C 1512300 
,aC 1 51 2400 
Cl 51 2500 
Cl 512600 
C 15127C0 
C 1 51 2800 
Cl 512900 
C 1 51 3000 
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n n,n nnnnnnnnn 


IFILEOUIPRINT 202 . s x r . ( S T 3 ( I ) . I = 1 , N s r J 1 
CALL ONPAC ( S T4 .NS T4 , SVD ) 

IF (LECU)PKIN T 203 . S VD , t S T 4 < I ) , I = 1 . NS T 4 1 


C 

C 

C 

C 

C 

c 


CCVPLIc VECTORS FRCM HINGE FLINT 
STORE UPPER TRIANGULAR 


K-l TO BODY LAMEA CENTER OF, MASS 


TO 5045 


• L) 


• L ) 


KLL iLl.L.L 


2 3 
10CC 


C 1513100 
C 1 SI 3200 
Cl 51 3300 
C 1 51 3400 
C 1 51 3500 
Cl 51 3600 
C15137C0 

AFTER FIRST PASS RECOMPUTE CNlY THOSE GAM VECTURS WHICH ARE TIME VC15138C0 

Cl 51 3900 
Cl 51 4000 
C l 51 4 1 00 
C 1 514200 
C 1 514300 
C 1 514400 
0 514500 
CISI46C0 
C l 51 47C0 
Cl 51 480C 
C 1 51 4900 
C 1515000 
C 1 51 51 OC 
C 1 51 520C 
C l 51 5300 
C 151 5400 
C l 51 5500 
C 1 5 1 5600 
C 1515700 
C 1 515800 
C 1515900 
Cl 5160CO 
C 1 51 61 CO 
C 1 5162C0 
C 1516300 
C15I6400 
C1.5165C0 
C 15166CO 
Cl 5167CO 
C 1 51 68CC 
C l 51 6VC0 
C I 51 7000 
C l 51 71 CO 
C 1 51 7200 
C I 51 73 CC 
‘ Cl 51 7400 

FIRST PASS RECCMPL TE CNlY TIME VARY INC ELEMENTS CF XC I C Cl 51 7500 

IF K CONTAINED' IN SXT. ELEMENTS OF ROW K FRCM COLUMN 1 TC K C15176C0 
ARE EITHER ZERO OR ASSUMED TIME VARYING. INTERNAL LOGIC. SUWCIS177C0 
JN SET SPI(K-I), SKIPS ZER. ELEMENTS C15178C0 

IF K CONTAINED IN SXT. ELEMENT IN ROW NBOD+l COLUMN N IS C1S17900 

ASSUMED TIME VARYING C1518000 

IF K NUT CONTAINEC IN SXT ABOVE ELEMENTS ASSUMED CONSTANT .AN.C.l'S 1 8 1 OC 
EC1LAL TO VALUE OEFINEC ON FIRST PASS THROUGH • CIEI82CC 

IF HINGE K-l IS A RICIC HINGE INERTIA TENSORS IN ROW K NOT. C-lSie30C 

NEcOEO FOR DYNAMICS HCWEVER T FEY ARE NECESSARY FOR CC N'ST.R.A IN C 1 S 1 a 40 C 
i*', U. l-Xt C M - 

TCRUUfcS, NU LCGIC TO AVOID TH IS SINCE IT »ILL 6E HARDLY EVERC1 518500 

SXT STORED If' ST 3 ARRAY Cl 51 6600 

IF IN S T3 .60 .0 1 GO TC 5046 CISI87C0 

CC 6 <F=l,NST3 C1S188C0 

IFILEGUIPRINT230 C15189C0 

K - = ST3IKP) CI519CC0 


22 CONTINUE 

.. IF (NST4 .EO .0 ) GO 
CO 3 LP = I , N ST 4 
L = S T 4 I LP ) 

KLL = MCINB1.L-1 
CO 4 1=1,3 

4 CAM I .KLL 1 = CAC ( I 

IF ILEUu 1FRINT 229 

,/ IFILEGu >L1 = L— 1 
IFILEOUIPRINT 204. 

LL = L 

5 X. = JCCMLL) 

IF(K.EU.C) GO TO 3 
KL = KTC (NBl .K-l , L) 

CALL VCCAOCl C8CI I .LL » .GAM 1 ,KLL) .GAM1 1 ,KL>) 

IF CLEttu IKl = K-l 

IF (LEGU IPR1NT 205. K L , K 1 . L , KLu . LL 
KLL = KL 
LL = K 
GO TC 5 
2 CONTINUE 
5045 CONTINUE 

IF ( . NOT. LEOU) GO TO 1C0C 

PR INT 2 3 C 

CO 22 K=1 ,n80D 

PRINT 229 

CO. 22 l=K.NQOO . 

KL = K I CINBl . K— l .L ) 

K 1 = K-l 

PRINT 221. hI.L.KL.IGAMI I , K L 1 .1 = 1 .3) 

PRINT 2 2 C 
CC N T INUE 

COMPETE ELEMENTS CF SYSTEM INERTIA TENS UR MATRIX 


AFTER 
1 ) 


) 


3 ) 


4 ) 
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1 c 


11 


IN = KT C INdGD . 0 . K-l ) 

SET ‘KIM DEFINES BODY LABELS ON PATH FROM FI.NGE POINT ZERO 
CENTER OF MASS CF BOOT K 
CALL UNFAC(STl.NSlltSKIM) 

IF (RELOIK) ) GO TO 7 


eccy k is a linear oscillator 

IFILECUIFRINT 206 . K 
IF (LEGO JPRINT 232. K 

IF (L ECU ) PRINT 207 iKiISTi (JJ).JJ=1.NST1 ) 
IF (LEGU)PRINT 229 

fill op rj# k to ciagcral 

IFCNST1 .EO.O) GO TC 6 
CO 8 1 1 = 1 .N ST 1 

I = ST1 ( II J 
Kl = KT1 (NOl . K . I I 
IF ( I .EG .K) GO TO 5 
IK = K T C (Nil 1 . I -1 . K ) 

CALL SCL VI XM AS <K ) ,G AMI 1 . IK ) , TEM) 

CALL C YCF ( TEM, XDI C I 1 . 1 .K I 1 ) 

IFILEGUUl = 1-1 

IF (L ECU )FR InT 208 . K 1 . K , I . K , 1 K . K . I 1 , K 

GO TC 8 

1F(CT4.NE.1) GC TC 8 
NK = K T 1 (Mil • N 8 1 . K 1 
CO 1C *=1.3 
>0 IC (M ■ * ,K I > = XM AS I K 1 
>0IC(*.*.NK) = XM A S I K ) 

IFILECUIFRINT 210. KI.K.l.K 
IF (LECU IFF INT 21C, NK.NBl.K.K 
CONT INUE 
CO TC 6 


TO 


BODY 
K 

232 . K 
229 

207 .K. (ST1 (JJ) ,JJ= 


CCNT INUE 

EOCY K IS A RIGIC 
IFILECUIFRINT 211 

if (leou jfrinT 
ifilegoiprint 

IF (LEGU 1 PRINT 2 07.K,IST1<JJ),JJ=1,NSTI) 

CC 11 1=1.3 

TE * 3 I 1 ) = 0 
CO 1 I J= 1. 3 
TEK1 I I . J 1 = 0 

■vi 

SPI(K-I) = SET CF GO C I E S IN NEST K-l CJNTRI8UTING TO PSUE CC 
TENSCRS OF NEST K-i 
CALL LNPACIST2 ,NST2, SPI I K-l 1 1 
IFILEGOIPRINT 212, K.K.IST21M) , M — l ,NST2) 

IFILEGOIPRINT 229 
IF (LECU 1FRINT 217 
■IF'lNSt* .EG. 01 GO TC 5047 
CO 12 LL=1,NST2 
L = ST2ILC) 

KL, V KT0INB1 .K-l ,L > "" 

CALL SCL V I XM AS I L 1 .CAM! l.KLI.TEMJ 
CALL VECADOI TEM3, TEM . TEM2 > 

IF (LEGO IK l = K-l 

IF (LEQU 1FRINT 213, L.KL.L.Kl.L 
IF ( .NOT .RoLOIL 1 I GO TO 12 
CALL CYADDITEMI.XICIl .1 .LI. TEM 1 1 


’ • l 


i jii 


C 1519100 
C1S19200 
C 1 51 9300 
. C 1E194C0 
C 1 51 9500 
Cl £1 9600 
C1S1970C 
C 1519800 
Cl 519900 
C 1 520000 
C 1 52 0 1 00 
C 1520200 
C 1 520300 
C 1 E 20 400 
C 1 520500 
C 1 52060C 
C15207C0 
C 1 520800 
Cl 520900 
C 1 52 1 000 
C1E21 ICO 
C 1 52 1 2 CO 
C 1 52 1300 
C1E214C0 
C1521500 
C 1 52 1 600 
C 1 52 1 700 
C 1 521 800 
Cl £21900 
C 1 522000 
C1522100 
C 1 522 2 00 
C 1 522300 
C 1 S224C0 
C 1 522500 
Cl 522600 
C l 52 2 7 OC 
C l 522800 
C 1 522900 
Cl 523C00 
C 1 523100 
C l 523200 
C 1 523300 
C 1 52 3 4 00. 

I NER C 1 5235C0 
C 1 523600 
C 1 523700 
Cl 523800 
C 1 52 39 00 
• f Cl 5240 00. 
C 1 524 1 00, 
C 1 524200. 
C 1 524300, 
C 1 5244 00 
C 1 5245 CC 
C 1 £24600 
C 1 5247C0 
C 1 524800 
Cl 524900 
C 1525000 
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IF (LECU JRR INT 213. L 



Cl £251 00 

i 2 

CUM INUE 



C 1 525200 

£04 7 

CONT 1NUE 



C I E25300 


NK = KT1 (Ndl .Nei . K) 



CIE25400 


CALL C Y CF ( TE M3 » XD 1 C { l , 1 , NK ) ) 



C 1 E25500 


IFILEUU IFRINT 2 l d • NK , N8 1 . K 



Cl E256CC 

C 

FILL CUT ROW K OVER TC OIAGCNAl 



Cl £25700 


IF (NET l . EO . 0 ) GO TO 6 



Cl£25e00 


CO 12 11=1, NST1 



Cl £25900 


I = ET 1 C 1 1 ) 



C 1 £26000 


K I = KT 1 CNB1 .K .1 ) 



C l£26 100 


CO 14 M = 1 , 3 



C 1526200 


CO 14 N= 1 , 3 



Cl E2&3C0 

1 4 

TEM2 <M ,M = C 



C 1 £20400 


IF (LECU >FRIN T 220 



C 1 £26500 


IF (NST2 .EQ.C ) GO TG 504e 



C 1 £26600 


CO IE LL=1,NST2 



C l 526 7 CO 


L = ST2ILL) 



Cl £26800 


KL = KTCCNril • K— 1 . L ) 



Cl £2b9C0 


IL = KTCINdl . 1-1 ,L ) 



Cl £27000 


CALL SUE CP lO AM ( 1 i KL) .GAMll . IL) .XMAS IL ) , TEM« ) 



C I £27100 


CALL C Y ACO( T EM. 2 . TEM4 . TEM2 > 



C 1 £27200 


IFCLEUUJM = K-l 



Cl 5273C0 


IFILEOUlIl = 1-1 



C 1 £2 74 00 


IF (LEGu IFKIN T 221. L . K 1 . L . I 1 .L . I 1 .L .M . L . XL . 

IL .L 


C 1 £27500 


IF (LFGU IFRINT 222 



Cl £27600 

1 £ 

CCNT 1MJE 



C 1 £277 CO 

50 4 £ 

CCNT 1NUE 

• 


Cl £27800 


CALL CYACCITEM1 .TEM2 .XC1C1 1 .1 »K1 ) ) 



C 1 52 7900 


IF (LEJu JFK INT 224. KI.K.l 



C 1 528CC0 

1 J 

CCNT INUE 



C 1 £28100 

e 

CCNT INUE 



C 1 £28200 

5C45 

CONT INUE 



C 1 £28200 


IF ( CT4 .NE . 1 J GC TC 17 



C 1 £20400 


NN = KT 1 (Ntil .Ndl . NEI 1 



Cl £28500 


CO 1 £ K=1 .NOCO 



Cl £28600 


CO 1 £ 1 = 1.3 



Cl £28700 

i e 

XDICO.I.NN) = XO ICC 1. I .NN 1 + XMAS(K) 



C l £28800 


IF (LEUU 1FR IN T 22E. NN, NEI. NEI 



C l £28900 

1 7 

CCNT INUE 



C l £29000 


IFC.NCT. LEO U ) GO TO 1C0I 



C 1 £291 00 


PR INT 2 3 C 



C 1 £29200 


CC 24 K=l.Ndl 



C l £29300 


CO 24 I=K,NB1 



C 1 £29400 


IK = KT 1 ( NB 1 , I ,K ) 



Cl £29S0C 


FR INT 229 



Cl £29600 


FRINT 222. ( XC ICC l .L . 1 N ) .L= 1 . J) 



C 1 £2 9 7 CO 


PRINT 234. I .K , IK . (XDICC 2 ,L .IN) .L = l . J) 



C l £29e00 


FRINT 232, C XD ICC 3 .L . I K ) ,L= 1 . J > 



C l £29900 

24 

continue 



C 1 £30000 

100 1 

CONT INUE ' '■'* • ’ ' '• *' ' • 



C 1 £30 IOC 

c 




C 1 £30200 

202 

FORMAT <• S X T = ’,28. ' ELEMENTS OF' 5XT = *, 

10 15 

> 

C1£3C3CC 

. .. 20 j 

FORMAT (• SVD = '.ZB,' ELEMENTS OF SVC = *. 

10 15 

> 

C l £304CC 

204 

FORMAT (• GAMC',12. 1 ) = GAM C * . I 2 . • . * . 12 . • ) = 

C AC ( 

• . 12, • ) • ) 

C 1 530500 

205 

FORMAT I* GAMC',12. •> = G AM C • • I 2 , • , ' . I 2 . • ) = 

GAM < 

• . 12 , • ) ♦ CSC C 

■ . 1 C 1 £30600 


*2. • 1 • I 



Cl 5307C0 

20 £ 

FORMAT (• U CD Y '.I2.' IE A L I NCR OSCILLATOR 

• ) 


C 1 £30800 

2 C 7 

FORMAT C' NUN-ZERC COLUMNS CF ROW ' .12.* OVER TO 

C I AGONAL ARE • 

, 1 C Cl 53C9C0 

♦ IS./) *” 



CI531000 


A-92 


non 


2 C £ FORMAT (• XD1C(*.I2.*1 


XO IC( • . 12 . • 


r. 


. • > = XMASC.I2.' )«DYOF(6CI£31lCC 


*AM<*,12.*1) = XMASI • . 12 . • ) *CYJP( GAM( • , I 2. • . • , 12. • ) ) •) 


21C FORMAT l* XDICI*. 12. •> = XC I C ( • • I 2 . * . * . 12 , 

211 FORMAT (• BODY 1 ,12,' IS A RIGID uCDY ■) 

212 FORMAT (• TJ GOT INERTIA TENSORS IN 


• ) = XMAS I • , I 2. ' 1* I 


12.* COLUMNS l THROUGH 


C 1 E312CC 
C 1 S3 l 3C0 
C 1 S31 400 
Cl 531 SCO 



♦ •* 12 • • 

£ CM OVER ECC I ES * . 

1 C 151 


C1S316C0 

212 

FORM AT 

( EX • * 

TEN3 = 

TEM3 

♦ XMASI * . 12. • 1 *GAMI * . 

12. • > = TEM3 

♦ XMASI Cl E31 7CC 


* •. 13 , • 

) * GAM ( 

• . I 2 . • . 

• . 12. • 

1 * 1 


C 1 S31 8C0 

21 v 

FORMAT 

C EX • • 

TEM 1 = 

TEM 1 

♦ XIC1 * . 12. * 1 * 1 


C l S 3 1 9 C 0 

2 1 7 

FORMAT 

(EX. • 

TEM1 = 

0 . 

T E M3 = 0 • > 


C15320C0 

2 1 a 

FORMAT 

( • XD ICC * , 12 

. • 1 = 

XDIC< * . 12. * . * . 12, • 1 = 

SK£*(TEM21 1 

1 Cl S32 1 CO 

2 2 C 

FORMAT 

< EX . • 

TEM2 = 

0 ■ 1 



C 1 S3220C 

22 1 

FORMAT 

( sx . • 

TEM 4 = 

XMAS ( 

* . 12, • 1*1 GAMI * , 12. * . 

* . 12. • 1 .GAM ( 1 

.12. * . • Cl S32300 


*.I2.*1*1 - GAMI • . 12. ■ . • . 12 , • 1GAMI * . 12. • . • , 12. • ) > = SUEGPIGAMC 

♦ •• ) .CAM! • . 12 . • > .XMASI • . 12. • 1) *) 


222 
224 
226 
228 
229 
220 
22 l 
222 

232 

234 


FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
♦ X •,/) 
FORMAT 
FORMAT 
RE TURN 
£NC 


I SX • • TEM2 = TEM2 ♦ TEM4 •) 

(• XD IC(*« 12.*) = XDICI*. 12.* 
(• XO I C ( ' . 12 . 1 ) = XDIC I * • I 2 , 

(•1 SU8ROLTINE XCY ENTERED • 
< • • ) 

I 2 I / ) ) 

(• GAMI • . I 2 . • . • . I 2 . • > = GAMI* 
(/.* COMPUTE ELEMENTS 


12 . * 

. 12 . 


. 12 .*) = 

I N RO* * i 


= TEM1 ♦ TEM2 •> 

= (TOTAL MASS>*1 


* . 301 7 .a 1 

12. ■ OF INERTIA 


( 27X . 30 1 7. 8) 

I • XDICI * . 12 , 


* .* .12.*) = XDICI*. 12. •> = *.3017. 8) 


I 2C 1 S324C0 
C1S3250C 
C l S32600 
C 1 5327C0 
) C l S3 2800 
Cl 532900 
C 1 E330C0 
C 1 5331 CO 
C 1 S33200 
MA TR I C l 533300 
Cl 533400 
Cl E33500 
Cl S 3 3 600 
Cl 533700 
.C 1 533800 


subroutine eta 

USE TO COMPUTE GYROSCOPIC CROSS COUPLING TERMS DUE TO 
1) INERTIA CROSS COUPLING 
21 CENTRIPITAL CROSS COUPLING 
31 CORIOLIS CROSS CCLPLING 


LET: 


ETCII.Kl = COMPONENTS OF GYROSCOPIC CROSS COUPLING TORQUE 
ON NEST K-I 


IMFLICIT REAL*8< A-F.O-Z ,51 
LOGICAL FG1 « FG2, FG3. FG4 . 


LOGICAL 


FGS. INEKF, H8LC. LEGU. LIMTIII 
LRUNGE • LTRNSI , LVOIV • LEOUIV , LTRAN 

LTRANV , LRATE . LXDY . LETA , LTOFOU . 

LCFOOT . LDCT . LANGLE , LSETUP , LSI MQ 


INTEGER 


Cl £00000 
ClfCOlOO 
C 1600200 
C I 600300 
C I £00400 
C 1 600500 
Cl 600600 
C 1 600700 

c i eooaoc 

C 1 600900 

ci eoiooo 
cieoi too 

C 1 60 1 200 
C 1601200 
C 1 60 1 400 
CI £01500 

c i eoi eoo 

C l 60 1 700 
Cl 601800 
C I 601900 
’Cl'60200 0 
C 1602100 
C 1 602200 
C 1 602300 


♦ 

AfcORK • 

CTl 

. CT2 . 

C T 3 

. CT4 . 

CT 5 

• F CON 

• PCON 

• 

C 160240C 

* 

SCNCUM • 

SCN 

. SCROUM. 

SCR 

• SFKDUM* 

SFK 

. SFR 

. SG 

* 

C 1 602500 

* 

S I 

S IG 

. SIXDUM. 

SIX 

• SKOUM • 

SK 

. SL 

. SL K 


C 1 602600 
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ftn n n n n 


5 


* 

SNA 

. SMC DU M. 

$V.C 

• SMV 


SG K 

. SPIDUM 

* 

SPI 

• SQF 

. C 1 £02700 

* 

SGL 

a SR . 

$ SC N 

. S S IX 


SVA 

. S9B 

• 

3VD 

• SV I 

, C 1 602800 

♦ 

SVM 

. SVP , 

SVQ 

f S XV 


SXT 

, TOOd 

• 

SMAL 

t SE U 

. C 1 602900 

4 

SC 

. SCG • 

NFL XB 

• sflx 


SF XM 

. NMGuS 

t 

SFCC 

• see 

. C 1 £03000 

4 

I IN I T ( 1 ) , 

IZINITt 1) 


SO 





C 1603 100 












C 1603200 












Cl 603300 


pe al *e 










C 1 603400 

4 

ANGC 

(23) 

CNF 

<2,10 

• 

ET 1C 

(3.10) 

• 

ETMC 

(3.10) 

. 0603500 

4 

FLO 

12.20) . 

fle 

< 2.3 .29 ) 

• 

FLH 

(3.3 .20 ) 

• 



C 1 603600 

4 

ThACD 

123) . 

YMCD 

(2.2.11) 

• 

r im r 

( 1 ) 

• ■ 

■KZINIT (1 ) 

0603700 


CCVMCN 

/LDE6UG / LKLNGE . 

LTFNS1 . 

LVDI V 

, i-EOUIV 

. LTL AN , 

C 1 603800 
Cl 6C3900 
0604000 


LTPANV , 

LKATC . 

LXDY 

. LET A 

, LTOPUU , 

0604 100 


LCFDOT , 

LCCT 

L ANGLE 

. LSETuP 

, LSIMO 

0604200 


. i 





0604300 

CO VMCN 

✓LGGI C/ FG l . FG2 . 

F C 3 . FG4 

» Fo5 1 

INtHF. HdLO(lO) 

C 1604400 
C 1 604500 

CCVMCN 

/INITG/ A Mf 0 fi K ( 2 0 C ) 

. 



- • 

Cl 604600 
CI6047CO 
0604800 



* 

CTi 


. 

0 2 


# 

CT3 


. 

CT 4 


C 1 6C4900 

* 

■ * 

• C T 5 


* 

F CO N 

( 22 ) 

* 

J CC N 

(10) 

. 

lccn 

( 22 ) . 

Cl 605CC0 


* 

MC 

( 10 ) 

. 

NBl 


• 

Ni3CD 


. 

NCTC 

a 

0 1 605 IOC 


* 

NF £ F 


» 

NFKC 


. 

nfrc 


• 

nlor 

a 

C 16052C0 


* 

NV V 



N VO 


9 

NMUA 

. 

. 

NS VP 

a 

C 1 605300 


. * 

N S VC 


. 

F CC N 

(11) 

• 

50 


« 

SF F J 

(33) , 

C 1 605400 


* 

SC- 


• 

S 1 

( 55 ) 

. 

SlG 


. 

5L 


C 1 605500 


* 

SLK 

(23) 

• 

SVA 

< 10 ) 

• 

SCK 

(11) 

• 

SOF 

(11) 

Cl 605600 


m 

5CL 

(11) 

. 

SVV 


• 

SR 


• 

SSCN 


C 1 6057C0 


4 

SS I X 


. 

SVA 


. 

SVB 


* 

SVC 

. , 

C 160580C 


4 

SV I 


. 

SVM 


» 

SVP 

(22 ) 

• 

SVQ 

(22) 

C 1 605900 


- * 

SXM 

( ^ . 1 0 ) 

• 

SXT 


• 

TOFU 

(97) 

• 

SMAL 


C 1 6C6CC0 


* 

SEU 


• 

NTQ 


• 

SC 

(33) 


SCG 


C160610C 



NFL Xd 


. 

SFLX 


» 

SF XM 

(10) 

• 

NMUOS 


C 1 606200 


♦ 

SFCC 


* 

see 

(1C) 







C 1 606300 

c 













C 1 606400 

c 













C 1 606500 


• CC VMC N 

/ INTO 1 / 










C 1 6C660C 


4 

SCNCUM 


• 

SCN 

( 5 ) 

• 

SCRDUM 

a 

SCR 

(9) 

C 1 606 700 


■ 4 

sfkcum 


. 

SF K 

( 5 ) 

. 

SIXDUM 

a 

SIX 

(9 > . 

C 1 606800 


4 - 

SKDCV 


• 

SK 

( 5 ) 

. 

SPIOUM 

a 

SPI 

(9 ) . 

C16C6900 


\ 4 

SVCCJM 


• 

SVC 

( S ) 







Cl 607000 

c 













C 1607100 


CO VMC N 

/6EAL2 










C 16C7200 


4 

C A 

(2.10) 


CAC 

(2.10 


CL M 

( 10 ) 

a 

cc vc 

(3.11) . 

C 1 607300 


■ 4 

OCMC 

(3.11 ) 


ETC 

(2.11) 


E FM 

( 33) 

a 

FU MC 

(3.11) , 

C 1 607400 


4 

GAM 

(2.66) 


H 



HM 

(3,10) 

a 

HMC 

(3.10) . 

C 1 607500 


4 

H VC V 

( 10 ) 


PHI 

(2.11) 


PL M 

( 10 ) 

a 

OF 

(3.32) . 

Cl 607600 


. * 

QFC 

(2.33) 


CL 

(2.22). 


QLC - - - 

(3)22) ; 

a 

F Q MC 

. ( 2 .. 1 1 ) v . 

, C 1 607700 


■ 4 

T 






THA 

(33) 

a 

THAO 

(32) , 

C 1 6C7800 


4 

Th AC* 

( 10 ) 


ThAW 

( 10) 


XDIC 

(3.3,66) 

a 

XI 

(3,3.10 . 

C 1 6C790C 

- <■ 

X .* 

X IC 

(2,3. 1C) 


XMA S 

(10) 


XMN 

(33.33) 

a 

XMT 

( 3 . 2 . 1 C. J . . 

_C 1 608000 


4 

T LG 

l 23) 


FLA 

U.2CI- 


FLB ‘ 

( 3 *,20) ■ . 

a 

FLO 

(3.20): r. . > 

~>C 1 608 IOC 


4 

FLO 

(2,3.20) 


FL J 

( 2.3 .20 ) 


CAO 

(3.10) 

a 

X 10 

( J. J . I C ) . 

C 1608200 

- 

4 

FLIPC 

(2.10) 


FLCRC 

(2.10 


FLAC 

(3.20) 

a 

FL QC 

(3,20) . 

C 1 6C8300 


4 

FLC V 

( 20 ) 


Z6TA 

< 20 ) 


FCF 

(3.3,40) 

a 

FCK 

(3.40) . 

C 1 608400 


4 

T I M 6 NO 











C 1 608500 

c. . 













Cl 6C86C0 
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COMMCN /REAL2/ 

* CEOUM <1.3) . CE <3.10 

* XMCCUM< 1. 1 .5) . XMC <3.3.13) 


CoCDUMI 1 ,3 ) 
CdM 3) 


CdC 


<3.10) 


EQUI VALENCE 


<ETM< 1 ) .THACC1 1 I ) 

<XMN< 1.3) . YMCC< l .1 .1 ) ) 

< XMN < 1 .6 ) ,E T IC< 1.1 ) ) 

< FL 0 < 1.1) .FLO< 1.1)) 
<FLH< 1.1.1 ).FLJ<1. 1.1)} 
<FG1 .LINI T< 1 ) ) 

< CHDUM< 1 .1 I.FZIMrill) 

< SCNDUM . I Z INI T < 1 ) > 


. < XMN 0.1). ANGD< 1 ) > . 

. < XMN < 1 .6 ) . CNF < 1.0) 

. < XMN ( 1,10) » E TMC < 1.1)) 

. <FLE 0.1.1) , FLO < 1.1.1)) 
• 

. <CA< 1 .1 ) .R IN IT < 1 ) ) 

. < AWOFKI D.IIMTIll) 


3 C 
:049 


INTEGER STK 10).ST2< 1 0 > . ST3< 13 ) .ST4< 10) ,3fc.T < 10) . SFXMN 

Cl ME NS I LN TEM< 3) . TEM 1 <3) ,TEM2< 3 ) . TEM3< 3 ) . TEM4< 3 ) . TEM5 < 3 ) . TEM6 < 

C I ME NS ION TEM7<3.3).TEM0<3.3).TEM9<3>.TEM1O<3) ,FLEC<3.3) 

eqlivalence <leta,leou) 


3 ) 


IF <L ECU )FR IN I 
CO 1 1=1.3 

TE M 3 < I ) = 0 
TEM6 < I ) = 0 
ETC< 1 , N0 1 ) = 0 


240 


REDUNDANCY IN 
CONThi I BUT 1 L NS 


CROSS COUPLING 
FOR EACH 000 Y 


3 1 
50 E C 


ISE 'SETS SS1X AND SSCN TC REDUCE 
COMPUTE INTERTIAL CROSS COUPLING 
IF <L ECU )FRINT 233 
CALL UNPAC<ST1 »NS T 1 . S S I X ) 

IF <N£T l .EU .0 ) GO TC 5049 
CC 3C 11=1. NST1 
I = ST1 < II ) 

CALL VXC YUV<FCMC< 1 . I > . X I C < 1 . I . I > . E T IC < 1 . 1 > > 
IF < L ECU )PR IN T 239. I . I . I , I . < ET IC < J . I ) . J = 1 . 3 ) 
CONTINUE 
CONTINUE 


COMPUTE FORCE ASSOCIATED » IT H CENTRIPITAl ACCELERATION OF 
'BODY IN THE SET ESCN 
CALL UNPAC < ST2 .N3T2 . SSCN ) 

IF < L EC O )FR IN T 234 
IF <NST2 .EQ .0 ) GO TC 50EC 
CO 3 1 l I 1= 1 . NST2 
II=NST2-<I 1 1 — 1 ) 

I = S T 2 < II ) 

IF < I .EO . 1 ) GO TO 3 1 

CALL TR IPVP < FOMC < l.JCONIll) .CdC < 1 . I ) . CNF < 1 , I ) ) 

IF < JCCNCI ) .EG. 1 ) CC TO 32 
■CALL VEC ADD< CNFO . JCON < I) ) , CNF< 1 , I ) , CNFO , I ) > 

IF (LEOU 1PWINT 235 . I . JCO N < I ) . JCON< I) , 3C0N < I ) . I 
GO TC 31 
CONT INUE ■ • • 

' if ileoOIprint 

CONT INUE 
CONT INUE 
IF <L ECU )PR INT 
IF INET2.EQ .0 ) 


EACH 


l - - I V. . * «* i X 4 

23 6', I . JCON< I ). JCONI'I ) .1 ' ' 


229 
GO TC 


SC E 1 


CO 33 I I 1 = 1 , NST2 


C 1 fCE700 

ci coaaco 

C 1C0U90C 
C 1 C09000 
C 1 609 1 00 
C l 60920C 
C 1 6C9300 
C 1609400 
C 1 609500 
C 1 609600 
C 1 609700 
C 1 609800 
C 1 609900 
Cl 61 0000 
C 161 0100 
C 161 0200 
C 1 6 1 0 300 
C I 6 1 0400 
C 1 6 1 0500 
Cl 61 C600 
Cl 610700 
C1610800 
Cl 61 090 0 
Cl 61 1 000 

ciei i ioo 
C 1 61 1200 
CCMP C 1 6 1 1 300 
C 161 1 400 

ciei 1500 

Cl 61 1 600 
Cl 61 1 7C0 

c i ci i eoo 

Cl 61 1 900 
CI 61 2000 
C1612100 
C 1 61 2200 
Cl 61 2300 
0612400 
C 1 6 1 2500 
Cl 612600 
C 1612700 
C 1 612000 
C 1 61 2900 
Cl 61 3000 
C1613100 
0613200 
Cl 61 3300 
Cl 613400 
Cl 61 3500 
Cl 61 3600 
C 1 6 1 3700 
01 613000 
C 1613900 
, . 0614000 
C 1 61 41 00 
C1614200 
C161420C 
C1614400 
C 1 61 4500 
Cl 61 4600 
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i I =NET2- ( I II -1 ) 

' I = £ T 2 < I I ) 

IF (I .E J . 1 ) GU TO 23 

CALL TR 1PVPIF0MC l 1 . I ) .C AC( 1 , I ) , TEM) 

IF ILEOL )FR INT 237 . I. I. I. I. I. I 
3 £ C ALL- VECADOt CNF! 1 , I ) .TEM ,CNF< 1 . I) ) 

CALI- SCLVI XMASI I ) ,CNF( 1 , I) . CNF C I . I ) ) 

33 CONTINUE 
5051 CONTINUE 

IFI.NCT. LEOU) GO TO ICOC 
FR INI 229 

IF 1NST2 .£0 .0 ) GO TC 1000 
CO 3 6 I 1= 1 . N3 T2 
I = £T2< II ) 

IF ( I .EU .1) GO TO 2o 

PRINT 226. I .(CNF(J, I) * J = 1 ,2) 

36 CONTINUE 
1000 CONT INUE 
C 
C 

C . 

C OEFOSMaTICN CCNTR IEUTICNE TC CROSS COUPLING 

IF ( N E u X c .£0. C) GO TO 3£ 

MN = 3 

call unpaciset .nset.sflx i 

IF(lEOu) PRINT 2 52. < SE T ( I ) , I = 1 , N5E T ) 

00 AC NN=1 .NEET 
N = EE I ( NSETF l -NN ) 

IF(LEOU) PRINT 2E2. N 
CO 37 I = 1 . 3 
TEM9<I) = 0. 

CO 37 J = 1 . 3 
27 TENetl .21 = C. 

IF(CECU) PRINT 231 
EFXMN = SFXM(N) 

CO 39 M=1,SFXMN 
VN = KN ♦ 1 

CALL 0 YOF (FLOCt 1 . MN) . TEN7 ) 

CALL TENTRNI FLE< 1 , 1 ,MN ) , XVC ( 1 ■ 1 . N I ,FLEC) 

CALL C YACDtFLEC. TEM7.TEM 7 ) 

CALL SCLCI TNAOI NFERtMN ) , TEM7, TEM7 ) 

CALL 0YACDtTEM8.TEM7.TEPt) 

CALL SCL V( THAO (NF ER + MN ) , FLAC ( l . MN ) , TEM l 3) 

CALL VEC ADD! TEM9 . TEM 1 O . TEM9 ) 

IF ( .NOT .LEOU ) GU TC 50C1 
PRINT 2 E 1 . HN.N.MN.N 
NF C X = NFER+MN 
PRINT 222. NFOX.MN.MN 
PRINT 2 A 2 « NFOX.MN 
EOCI CONTINUE 

.. 3 9 CONTINUE , 

CALL CYCCT V( TEM8.FCMCI 1 .N > .FLIRCI 1 .N) ) 

CALL 5CLV< 2. 000 .TEM9 ,TEV9 ) 

t CALL SCL V ( XMjASjt N ) .,76 M.9/, ijSuG3 ttlirtj JAITRJilI L1 1 I »’>, • .1 7 V, 33 

CALL VECFOS ( F CM C ( 1 , N ) , T E M 9 .FLCKC(l.N)) 

CALL VEC ADO ( E T IC ( l.N) .FLIKC(l.N) .ETICI 1 . N ) ) 

CALL VECADDt CNF { 1 . N ) , F LC RC ( 1 . N ) , CNF ( 1 , N ) ) 

IF( .NOT. LEOU > GC TC 50C0 

PRINT 2 A A . N .N.IFLIRCC I .N) .1 = 1 .3) 

PRINT 2 A 6 • N,N.N.(ETIC(I.N),I=I,3) 


Cl 61 A700 
C 1 6 I A 800 
C 1 61 A930 
C 1 61 5000 
C 1 61 51 00 
C l 61 5200 
C l 61 £300 
Cl 615A00 
C 1 61 5500 
C 161 5600 
Cl 61 5700 
C 1615800 
Cl 615900 
Cl 61 6000 
C 1 61 61 00 
C 1 61 6200 
Cl 61 6300 
C1616A00 
C 1 616500 
Cl 61660C 
C 161 6700 
C16168CC 
C 1 61 6900 
C 1 6 1 7000 
C 1 61 7 1 00 
C 1 6 l 7 200 
Cl 61 7300 
C 1 61 7 A 0 0 
Cl 617500 
C 1 61 7600 
Cl 61 77CC 
C 1 61 7800 
C 1 6 1 7900 
C16180C0 
Cl 61 8100 
C 1 6 1 8200 
C1618300 
C 1 61 e ACC 
Cl 618500 
C 1 61 860C 
C 1 61 8700 
Cl 61 8800 
C l 61 8900 
C 1 61 9000 
C 16 19 ICC 
C 1 61 9200 
Cl 61 9300 
C 1619AC0 
C 1 6 19500 
C1619600 
Cl 61970C 
Cl 61 98C0 
C l 61 9900 
C l 620000 
C 1 6 2 0 l 0 0 
C 1620200 
C 1 620300 
C 1 62 040 0 
C 1620500 
Cl 620600 
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/ 



r> n 


PRINT 24E. N ,N , N . <FLCRC( I.N1.I— 1 .31 
PRINT 247. N.N, N. <CNF ( I ,N ) , 1=1 .3) 

SOOC CONTINUE 
«c continue 
3E CONTINUE 

c 

c 

c 

c eliminate redundant computation in momentum gheel cross 

C CCUFLINC COMPUTATION ey etmc 

c 

IF(NNC.EQ.O) GO TC 5C52 
IFCLECU JFRINT 206 
CO 1C M=1.NM0 

CALL VECFOS (FCMC { 1 .M0( N ) ) ,FMC ( 1 .M) ,ETMC( 1 .M ) ) 

CALL SCLVI HMGM(M) ,ETMC ( 1 ,M) .ETMCI 1 • M) ) 

IF (LEGU)FRINT 2CT » M . M , MO ( N I . M , l ETMC ( I . M ) . I = 1 , 3 I 
1C CONTINUE 
50 1 2 cat\1 l\Ut 
C 

CC 2 K=1.NB0D 
CO 3 1= 1 , 3 

2 ETC ( I , K ) = 0 
K 1 = K- 1 

IF (LEGU IPR INT 225 . K1 
C SET LF SUMMATION SETS FOR NEST K-l 

C INERTIA CROSS COUPLING 

CALL UNPACIST 1 ,NST 1 . SI X ( Kl I I 

IF (LEOU) FLINT 200.Kl t SIMKl).(STl(I).I = l.NSTl) 

C CENTRIPITAL cross coupling 

CALL UNPAC(ST2,NST2.SCN( Kl ) } 

IFILEGU 1FKINT 201. Kl , SCMK 1 ) . ( ST2( I ) , 1 = 1 .NST2 ) 

C CCRICLI S CROSS COUPLING 

CALL UNPAC(ST3.NST3.SCR<K1 ) ) 

IF CLEGu 1FRINT 202 . K 1 , SCR ( K 1 > , ( ST3 ( l ) . I = l ,NST3 » 

C MOMENTUM *HEEL CROSS COUPLING 

CALL LNPACCST4.NST4.SMCIK1) > 

IPf.NCT. LEQU} GO TO 1C0J 

PRINT ECS. K. 1 , SMC <Kl > , ( ST4( I > . 1 = 1 .NST4 » 


FRINT 229 
FRINT 2 C 2 . K 
IFIK.NE.ll GO TO 5 
PRINT 202. N31 
FRINT 22 C 
S CONTINUE 

C INERTIA CROSS COUPLING 

FRINT 241 
FRINT 2 2 E 
10.0 1 CONTINUE 

IF ( . N JT .fitJLU (K > 1 GC TO 4 
IF ILEGU IPR INT 204 , K.K 

C SUN CVER UNLY TFCSE ECCIES OF NEST K- 1 «HICH SIGNIFICANTLY 

C CONTRIBUTE TO INERTIAL CROSS COUPl I NG ' 1 N- EGU AT‘I CNS • OF 

C NOTION OF NEST K-l 

IFINST1 .EQ.O > GO TC 4 
CO 6 LL=I .NST1 
L = ST 1 ILL ) 

IF (LEGU 1FRINT 205. K.K.L 


C 1 C20700 
Cl 62 0800 
Cl £20900 
C 1 62 l 000 
C 1621 100 
C 1621200 
C 1 62 1 30 C 
C 1 62 1 400 
C162I500 
Cl 62 1 600 
Cl 62 1700 
01 62 1800 
Cl 62 1900 
Cl 622000 
C 1 622 100 
C 1622200 
C 1 622300 
C 1622400 
C162250C 
C 1 622600 
Cl 622700 
C 162280C 
Cl 622900 
Cl 623000 
C 1 623 100 
C 1623200 
C 1 62 330 0 
C 16234C0 
C 1 623500 
C 1623600 
Cl 62370C 
C 1 62 380 C 
C I62J90C 
C 1 624000 
C l 624 100 
C 1624200 
C 1 624300 
C 1 62 4 400 
Cl 624500 
C16246C0 
C l 624700 
C 1 62480C 
C 1 6249C0 
C 1625000 
C 162510C 
C 162520C 
C 1 625300 
C 1 625400 
C 1 625500 
C 1 625600 
C 1 625700 
C 1 625800 
Cl'625900 
CI62600C 
»■- Cl 626 100 
C 1 626200 
C 1 626300 
C 1 626400 
C1626S00 
Cl 626600 
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on ", n n n 


1 4 


9 

5053 


i e 


l e 


CALL \,CCSUd( ETC( 1 .K) ,ET IC( 1 .L> .ETC( 1 ,K) ) 

NOTE redundant vector adciticns less costly than logic needed 

AVOID TEEM 

cont inue 

IF (LECU JFRINT 216. K . ( ETC( I .K ) , 1=1 )3) 

CENTRIP1TAL cross COOPLING 

IF (LEOO)FRINT 241 
IF (LEGO JFRINT 22/ 

IF(NST2 .EO.O ) Go TC 7 

co a i = i . 3 

TEW4 ( I ) = 0 

TEW 2(1) — 0 

SUW OVER ONLY THCSE ECCIES OF NEST K- 1 WHICH SIGNIFICANTLY 
CONTRIBUTE TO CENTR1FITAL CROSS CoOPt-ING IN EUUATIONS OF 
WCTICN OF NEST K-l 
IF (LECU )PR INT 206 
IF (NST2 .EC .0 ) GO TC 5053 
CO 9 LL=1 • N ST2 
L = ST2U-LI 
LC = L 

IF(LC.EC.l) GO TO 9 
.IF(RELOIlO) GO TO 22 
CALL VECSUbl TEM4.CNF1 1 .L J.TEW4) 

IF (LEOO JFRINT 21 1 . L 
GO TC 9 

IF(K.NE.1)G0T014 ' 

CALL VECEUdl TEM3.CNF( 1 ,L J.TEWJ) 

IF (LECU JFRINT 212 . L 
KL = K T C I Nt)l »K — 1 . L ) 

CALL VECF03 (GAM( 1 ,KL) .CNF ( 1 ,L ) . TEM) 

CALL VEC5UBI TEM4 , TEW . TEM4 > 

IFILECUJM = K-l 

IF (LECU IFRINT 213. Kl.L.L 

IF(LECU JFRINT 229 '' 

CONTINUE 

CONTINUE i 

CALL VC C ADD ( ETC! l.K),TEW4.£TC(l.K>) 

IFILECUJPRINT 214. K, K, ( E TC ( I . < ) . I =1 . J ) 

IF(K.NE.l) GO TO 7 

CALL VcC ADOl ETC( I ,NB1 ) • T EM3 .ETC( 1 . Nfll ) ) 

IF(LECU)PPINT 215. NH1.NE1. ( E TC ( I . Nb 1 ) . I =1 . 3 ) 

CONTINUE 

CCRIOLIS CROSS COUPLING 
IF (NST3 .EQ .0 > GO TC 15 
IF (LECU )FR INT 241 
IF (LECU IFRINT 226 
CO 1€ 1=1.3 

TEW 5 ( I ) ' = 0 

SOW OVER ONLY TPCSE BOCIES' JF NEST* K~- ! 17»H1CH- SIGNIF ICANTLY 
CCNTRISU'TE TO CORIOLIS CROSS COUPLING IN' lOUATIONS'CF 
WCT ICN OF NEST K-l 

IF (LECU )PK INT 217 ' ‘ f -~,i ' • 

TF(NSTJ.EC.O) GO TC 5054 
CO 1 7 LL= 1 . NS T3 
L = STS (LL ) 

CALL VECROS (FCMC ( 1 .L ) .KCMC ( 1 ,L) .TEM) 

CO I e 1=1 >3 

TEW2(I) = 2 .D0*XMAS( L )* TEM ( I ) > - 


TO 


t Q ^ ’ 


C I €26700 
C 1 €26800 
C l €26900 
C 1 €27000 
C 1627100 
C 1 62720C 
C l €27300 
C I €27400 
C 1 €2 7500 
C 1 €2 7 60 0 
C 1 €27700 
Cl 627800 
C l €27900 
C 1628000 
C 1 €26 100 
C 1 €28200 
01628300 
C 1628400 
Cl €2e500 
C 1 €28600 
C 1 628700 
C l 62 880 0 
Cl 628900 
Cl 629000 
C 1 €29 1 00 
C 1629200 
C 1 629300 
C 1 629400 
C 1 €29500 
Cl 629600 
C l 629700 
C 1 629600 
C 1 629900 
C 1 €30000 
C 1630100 
C 1630200 
C 1 630300 
CU3040C 
Cl €3050 C 
C 1 €30600 
C1630700 
Cl 630800 
Cl €30900 
C1631000 
Cl 63 l 100 
C 1 6 3 1 20 0 
C163130C 
C 1 63 1 400 
C 1 631500 
Cl 631 €00 
'•Cl 631 70 0 
C 1631800 
C1631900 
■ C1632C00 
* ’ Cl €32 1 00 
Cl €32200 
C163230C 
: C 1632400 
C 1 €32500 
C 1 €32600 


A-98 



1F(LEGU)PNINT 2X9. l.l.l 

iF(aei.a(K) > go tc 20 
co 2 1 x = 1.3 
2 1 T E M 5 II) = -TEM2X I > 

IF ( L ECU ) PR l N T 221 
GO TC 17 

2C HL = KTCtM>l.K-l,L) 

CAUL vECRUS (GAM l,KL).TfcX2.TEH) 

CALL VtCSUdITtM5.TEM.TEME) 

IFILEGUIKI = <C- l 

IF (LtCU 1PR1NT 222. Kl.L 
IF(K.Nt.l) GO TO 19 
CALL VtCEUBlTCM6.TEM2.TEX6) 

IF (LEOU )PR INT 220 
19 CONTINUE 

IF (LECU)PRINT 229 
17 CONTINUE 
E 0 5 A CONTINUE 

CALL v& C AUDI ETCCI ,K ) . TEM E . E TC ( 1 . K ) ) 

IF (L EUU )PR' INT 223 , K . K .( £ TC < I . K ) . I = 1 . J J 
IFCK.Nt.l) GO TO IE 

CALL vEC ADOI ETC! 1 . N B 1 ) .TEM6.ETCll.Nai)) 

IF (L EGU )FK IN T 22 A • NB 1 . N E 1 . ( E TC { I . NB 1 > . I =1 . 3 ) 
IE CCNT InUE 


: MOMENTUM nFEEL CROSS COUPLING 

IFINST4 .fcO.C) GO TC 5055 
IFILEOUIPRINT 241 
IF (L EOL 1PR INT 210 

CO 11 MM=1,NST4 
M = ET4(MM) 

IF (L ECU 1PR1NT 21B. K.K.M 

CALL VECSUot ETC( 1 .K) , E T MC < 1 .M) ,ETC(1 . K) ) 

1 1 CCNT InuE 
SOEE CONTINUE 

IF ( L E GU )FR I N T 216. K , ( E T C ( I .K ) , I = 1 , 3 ) 


2 CONTINUE 


C 1 £32 700 
. 0 l £32 80 0 
C 1 £ 32 90 0 
C 1 £33000 
C 1 £33 100 
C 1 £33200 
C 1 £33300 
C 1 £3340 0 
,C 1 £33500 
C l £33600 
C 1 £33700 ■ 

C 1 £33800 
Cl £33900 
C 1 £34000 
C 1£34 100 
C 1 £ 34 20 0 
,0634300 
C 1 £34400 
C 1 £34500 
C 1634600 
C 1 £34 700 
Cl £34800 
C 1 £34900 
C 1 £3500 0 
C16351007 
C 1635200 
C l £35300 
C 1 £35400 
C 1 £35500 
C 1635600 
C1635700 
C 1 £35800 
Cl £35900 
'Cl £36000 
C 163 6 1 0 O 
C 1636200 
C 1 636300 
C 1636400 
J C 1636500 

' C 1 £36600 

C 1 636700 
C 1 £36800 
01636900 

CCNTRIoUTERS TC INERTIAL CROSS C1£370C0 
. . C1637100 

CCNTRIOUTERS TO CENT R I P I T AL CRCC 163720C 
v , C 1 637300 

CCNTRIOUTERS TO CO R I.OL I S CRO S S C1C37400 

C 1 63 7 50 0 

) = 0 ' ) 




2 0 C FORMAT ( EX , 1 SIX ( • . 12 . • ) = ' , 2d 

♦COUPLING AWE BUOIES *,1015) 

20 1 FORMAT <SX,' SCN< ' , 12, • ) = '.2d 

*SS CCUPLING AWE dCCIES ',10151 
202 FORMAT (EX,' SCR('.I2,') = ',26 

* CULP LING ARE BODIES ',1015) 

202 FORMAT (' CROSS COUPLING TORQUE ETC! '.12.') = 0 •) Cl£37£00 

Cl 204) FORMAT <• ETC! ' . 12 )„,=,EjTC< ',:I2. •-)!, ' J.,';.,,', bEDn I ,ov., -:u Cl 637700 

20 E FORMAT (• ETC! • .12. • ). s ETC! '.12.') r ETI C ( ',. 1 2 .' ) •> CIC37B0C 

■206 FORMAT <20X,' TEM2 = 0 , T£ M 4 = 0 ') C1C37900 

..2C.7; .FORMAT I E X . • E T MC < • . I 2 . • ) = FMCM('.l2.') ♦ ( FCMC ( • ,,I 2, • ) /V _X BMC IJ % 1.2 C 1 63800 0 

C ••<>*,')) = * ,301 7.8) • •• •■; *“ ■ -'* -,-.*■',01638100 

208 FORMAT I//.5X, • INERTIAL CRCSS COUPLING TERM FOR EACH MOMENTUM tiFEC 1638200 

* EL • ,/ ) C 1638300 

209 FORMAT (EX,' SMC ( 1 , 12 , ' ) = • , 2d . • . CCN T R 1 BU T E RS T 0 MOMENTUM M FE EL C 1638400 

* CRCSS CCUPLING ARE ♦HEELS' .1015) 0638500 

210 FORMAT (• MUMENTUM *f£EL CROSS COUPLING. EFFECTS •) C1C38600 
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2 1 1 

FORM A T 

( 20X. • 

TE M 4 

= 

TEM4 - C NF ( • 

• 

12 

. * ) ' ) 





212 

FOPM A T 

( 20X, • 

TE M3 


TEN 3 - CNF! • 

• 

12 

• * ) « ) 




• • 

213 

FORMAT 

(20X. ■ 

TEM4 

= 

TER 4 - SAMI* 

• 

12 

. 4 . • . 12. 

• 

) X 

CNF ( 

4 . 12. 4 

214 

FORMAT 

1 • £ TC 1 

• . 12. 

* ) 

= ETC! • , 12. 

1 

) 

+ TEM4 

= 

• . 

3017. 

6 ) 

215 

FORMAT 

(* ETC! 

• . 12. 

* ) 

= ETC ( • , 12, 

1 

) 

♦ TEMJ 

= 

• . 

3017. 

6 ) 

216 

FORMAT 

( * E TC< 

• . 12. 

* ) 

= •.3017.8) 








2 l 7 

FORMAT 

( 40X. • 

TEM5 

= • 

C • 

) 







21 e 

FORMAT 

< • ETC! 

• . 12 , 

* ) 

= ETC( • . 12, 

• 

> 

- ETMC ( 4 

• 

12. 

4 ) 4 ) 


219 

FORMAT 

( 40 X • • 

TE M2 

= 

2 *X M AS ( * . 12 

• 

* ) 

* FOMC ( 

• 

. 12 

. 4 ) X 

RC MC ( 1 

• ) • ) 












2 2 C 

FORM A T 

( 40X • • 

TE M 6 

= 

TEM6 - TEM2 

t 

) 






22 1 

F.Q R M A T 

( 4 0 X , • 

TEM5 

= 

-TEM2 •) 








222 

FORM A T 

(40X, • 

TE MS 

= 

TENS - G AM ( • 

• 

12 

. 4 . 4 ; 12 , 

i 

1 X 

T EM 2 

4 ) • 

223 

FORMAT 

( • E TC ( 

• . 12 . 

* ) 

= ETC ( • . 12, 

I 

> 

F TEMb 

= 

• . 

JD 1 7 . 

8 ) 

2 2 4 

FORMAT 

(• t TC ( 

• . 12. 

1 ) 

= E T C ( • . I 2 . 

1 

) 

TcMo 

= 

• . 

JC 1 7 . 

8 ) 


22 5 FORM ATI 7 (/> . 

* • EC3DY LABELS CF THOSE BODIES ihICH SIGNIFICANTLY 

GYROSCOPIC CRCSS COUPLING TORQUES ON NEST *.I2./) 

• INERTIA CRESS COUPLING EFFECTS • ) 

CENTRIRITAL CROSS COUPLING EFFECTS •) 
CCRICLIS CROSS COUPLING EFFECTS •) 


♦RIELTE 
226 FORMAT 
FORM AT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
*C< • . 12 
232 FORM A I 
♦ SET SS 


227 

228 
229 
2 : 3 0 
23 1 
222 


TO 

( 

( 

( 

( 1 

( • 


20 X • • 
40X . • 

■ ) 

TEMJ 


0 . 

(10X,* TEM8 = 0 * .45X . 1 TEX9 = 0 •./) 

(10X.* TE M8 = TEM8 « TH AO ( • , 12 . • ) * ( FLE! C < 

.•))•> 

(//.SX,* INERTIAL CRCSS COUPLING CONTRIBUTIONS OF 
IX • ./ ) 


TEM6 = 0 <) 

0 * .4SX . 1 TEM9 = 0 
TEM8 « THAO( • , 12 , 


12. 


) 


234 FORMAT ( // , 5 X , • 

• AT ION CF CENTER 
23 5 FORMAT <eX,<CNF(* 

• • ) X CUCl • .12. • ) J 

236 FORMAT (EX. *CNF( • 

* ■ ) X CdC ( • . 12. ■ ) ) 

237 FORMAT ( EX. • CNF( • 

♦ • » X (FCMCl « . I 2 . • 
23 E FORMAT ( EX . • CNF< • 


*FCMC( 


12 . 


239 FORMAT 

* .* ) ) = 

24 C FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 

.30 12 

247 FORMAT 
• 2.S) 

25 I FORMAT 


INERTIAL FORCE ASSOCIATEO lilTH 
OF MASS CF EACH BODY IN SSCN *./) 
.12.*) 4 CNF ( • , 1 2 , • ) + FCMCC.I2 

• 1 

. 12 . • ) - • . 10X . 

■ 1 

. 12 . • ) = X M A S ( * . 12 
> X C AC ( • . 12. • I » • ) 

. 12 . • I = • .20 17. d > 

• . I 2. • I = F CMC ( • . 12. * ) 


> • ICNFI • , 12 


C 1 €36 700 
01638800 
• I Cl 63890C 
C 1639000 
C 1639100 
■ C 1 639200 
C 1 639300 
C 1 639400 
, I 2. • C 1 6395C0 
C 1 639600 
Cl 639700 
'C 1639800 
01639900 
Cl 640C00 
C 1 640100 
C 1 640200 
CCNT'C 1640300 
C 1 64 0400 
C 1 640500 
Cl 64 C600 
C 1 640700 
Cl 64C80C 
Cl 640900 
C l 64 l 000 
• SKEkl FLOC1 641 100 
C1641200 
EUCIES INC1641300 
C 1 641400 

CENTRIPITAL ACCELER C 1 64 1 500 
C 1 641 600 
) X (FCMC ( • , 12. C 1 64 1 700 
C1641800 

> X ( FCMC ( • . 12. Cl 64 1900 
‘ C 1 642000 
• ) ♦ FCMC ( • . 12. C 1 642 100 

C 1 642200 


X ( X I C ( > . 12. • ) 


FOMC ( 


24 1 
242 

244 
246 

245 


(EX. • ET 1C ( 

• .301 7.8) ’ • ' 

(•1 SUBROUTINE ETA ENTERED • ,2 < / I > 

131/) ) 

( 65X, • TEM9 = TE M 9 ♦ THAD( • . 12, • ) *FLAC l • . 12 . • ) • ) 

(/,• FLIRC ( • , I 2 . * 1 = TEM8.F0MC ( • , 12. * ) = • . 6X . 3D 1 2 . 5 ) 

(• ETIC(*.I2.*> = ETIC( ' ,12, • 1 + FLI RC ( • . 12 , • ) =',3012. 5) 

</.55X, *FLCKC< • ,12. • ) = 2* XM As< • . 12 , • ) *F UMC( • , I 2 . ' ) X TE M 9 
.5) 

(E3X, ■ CNF ( 1 ,12. •) = CNF ( • , 12 . • ) + FLCRC < • . 12 , • ) = 


( 10X. 


FLEC< 


12 , 


) = XMC< • . 12, • )*FLE( 1 


12. 


) *X MC ( • 


• AT • ) 

252 FORMAT <//.5X,‘ ELASTIC CROSS COUPLING CONTRI8U1 IONS DUE TO 

• ILITY OF QQD IES ' . 1CI 5, // ) ‘ ‘ ' ’ 

252 FORMAT ( ✓✓/ , 35 X , 1 ELASTIC CEFORMATICN EFFECTS DUE TO BODY* 

• RETURN 

' J "' , “ 5 ' J eAc \3DTnlN 


C 1 642300 
, I 2 C 1 642400 
' C 1 642 50 0 
C 1 642600 
Cl 642700 
C 1 64 2800 
C 1 642900 
Cl 643000 
C 1 643 IOC 
C 1 64 3200 
,9>, 2D1 C1643300 
C 1 643400 
. I 2. • )* C 164 3500 
C 1 643600 
FLEXIBC1643700 
’ T Cl 64 3800 
. 15 . / ) Cl 643900 
C 1 644000 
' nM ? 1644 100 


A-100 



n n 


C 

c 

c 


c . 
c 


c 

c 


c 

c 


c 

c 

c 

c 


c 



.. 












Cl 700000 


SUERCUTINE TGR0O6 ( Y • YD . 

NEC) 








Cl 700 100 














C 1700200 
C 1 7C0300 


IMPLICIT KEAL* 8 ( A-F .O-Z 

. 1 1 








Cl 700400 


LOG I C A i_ 

r G 1 . 

FG2 ., FG3 . 

FG4 . FG5 

. INERF 

t k3L Q * 

LEOU. L I M T ( l ) 


C I70C50C 


LOGIC AL 



L RUN GL 

. LTRN3I 


• LVUIV 

> LEQUIV • LTRAN , 


C 1 7C0600 

♦ 




L TP* A N V 

. LRATE 


. lxdy . 

• LET A 


• LTORCU • 


Cl 7 CO 700 

* 




LCFOOT 

. LOCT 


. LANGLE . L5E TUP . LSIMQ 


C 1700000 














C 1 700900 
.. Cl 701000 


INTEGER 












C 1701 100 


AtOPK 

. CTI 

• 

C T 2 . 

. C T 3 


CT4 

. CT S 


FCON 

. PCON 

• 

C 1 701200 


SCNCUM 

. SCN 

• 

SCR DU* 

. SCR 


SFKDUM 

• SFK 


SFR 

. SG 

t 

C 1701 300 


S I 

i SIG 

• 

S IXOUR 

. six 


SKDUM 

. SK. 


SL 

. SL K 

• 

C 1 701400 


S*A 

• SMLDUK. 

SFC 

. SMV 


SOK 

. 3PIDUM 


SPI 

. SOF 

• 

C 1 701 5C0 


SCL 

. SR ' 

• 

:SSCN 

. ssix 


SVA 

• SVB 


SVC 

. SV I 


c i 701 eoo 


SVM 

. SVP . 

• 

SVQ 

» SXH» 


SXT 

• TOKQ 


SMAL 

. SEU 

• 

Cl 701 700 


SC 

. SCG 

• 

NFL XO 

. SFLX 


SFXM 

• NMCDS 


SFCC 

. see 

• 

C 1 701 BOO 


I IN ITI 

1 ) 

• 

1 2 i n i t ( r» 


Sl> • 






C 1701900 














C I 702CC0 
C 1 7021 OC 


PEAL 












C 1702200 

4 

ANGC 

( 23) 

• 

CNF 

( 3. 1C) 

i 

ETIC 

(3.10) 

• 

ETMC 

(3.10) 

t 

C i 702300 

* 

FLO 

( 2.20 ) 

t 

FLE 

( 2*3.20 ) 

• 

FLH 

(3.3.20) 

• 




C i 702400 

* 

ThACD 

(33) 

• 

YMCD 

( 2 . 2 . 11 ) 

• 

RIMT 

< 1 ) . 

• 

RZINIT( 1 ) 


C-l 702500 














C l 7 C2fc0 0 
C 1 7C270C 


COFMCN 

/LCEBUG/ 

L RUN GE 

• LTRNSI 


. LVUIV 

• LEQUIV 

• LTRAN . 


C 1 702800 

* 




LTRANV 

. LRATE 


. L XD Y 

. LETA 


• . L TOR QU . 


C 1 702900 

4 




LQFDOT 

. LOCT 


..LANGLE . LSETUP , LSIMQ 


C 1703000 














C 1 7 03 100 
C 1 703200 


COPMCN 

/LOGI C/ 

FG1. FG2 

• F G 3 • FG4‘» F G 5 • 

I NERF . 

KBLOI 10) 



C 1 70330C 












* « 


C 1 703400 
Cl 703500 


COWMCN 

/ IN TG/ 


A *QRK 

( 200 ) 








C 1 7C360 0 


CT1 



CT2 



CT 3 



CT 4 


• 

C 1 703700 


CT5 



FCON 

( 22 ) 


JCCN . 

( 10 ) 


LCCN 

( 22 ) 

t 

Cl 703800 


IYC 

( 10 ) 


■ N fi 1 



NdOD . 



NCTC 


« 

C l 703900 


NFER 



NFKC ' 



NFKC • 



NLGR 


• 

Cl 704000 


NM V 



NMQ 



NMQ A 

, 


NS VP 


• 

C 1 7C41 00 


NSVC 



PCQN 

( 11 ) 


SO 



SFR 

( 33 ) 

• 

C 1 704200 


SG ■ 



S l 

( S5 ) 


SIG 



SL 


• 

C 1 704300 


SL* 

(33) 


S’* A 

( 10 ) 


SON . 

( 11 ) 


5 OF 

on 

* 

C 1 70440C 


SCL 

( 11 ) 


SMV 

• 


SR 



SSCN - 



Cl 704500 


S £ I * 



SVA 



sve 



SVD. 


• 

C 1 704600 


SV t 



SVM 



SVP 

( 22 ) 


SVQ 

( 32 ) 

• 

Cl 704700. 


SXM 

( 2 . 10 ) 


S>T 



TORO 

(97) 


SMAL. 


* 

C 1 704800 


seu 



NTQ 



sc 

(33) 


SCG 


• 

C 1 704900 


NFL > d 



SFLX 

- % t v ; - j 


.SFXM 

( 10 ) 


NMODS 



Cl 705000 














SFCC 



see 

( 10 ) 








C 1 7051 00 
C l 70520C 
C 1 705300 


CCMMCN 

/ 1NTGZ/ 











' C 1705400 

4 

SCNCUM 


• 

SCN 

( S ) . 

f 

SCRUUM 


• 

SCR 

(9) 

• 

Cl 705500 

♦ 

sfkclm 


* 

SFK 

(S) 

• 

SI XCUM 


• 

SIX 

(9) 

• 

C 1 7C5600 

* 

SKDLM 


• 

SK . 

(91 

* 

SPIOJM 


• 

SPI ■ 

(9). 

• 

C 1 7C57C0 

4 

SMCCLM 


• 

SFC 

(S) - 








C 1 705800 
Cl 7C5900 



' A-101 


a ■ n n n-n n n'n n 'n n n ri n n n n n n n n rt- n rt • r» in 


COMMCN /REAL/ 


Cl 706000 
C I 706 1 00 



C A , 

13,10) 


CAC 

(2.10 


CL M 

( 10) 


CCMC 

(3.11) . 

C 1 706200 


DCMC 

(2,11 ) 


ETC 

(2.11) 


ETM 

( 23 ) 


F CMC 

(3.11) . 

Cl 7C6300 


G AM 

(2.66) . 


F 



HM 

(2.10) 


HMC 

(3.10) . 

C 1706400 


HMC M 

( 10 ) 


PH 

(2.11) 


PL M 

( 10 ) 


CF 

(3,32) 

C 1706500 


■OFC 

(3.33 ) 


CL 

(2.22) 


GLC 

(2.22 ) 


«CMC 

(3.11) . 

C 1 7C66CC 


T 






THA 

(23) 


THAO 

(33) . 

C 1 7067C0 


ThACtf 

l 10 ) 


THAW 

(10) 


XDIC 

(3.3.66) 


X I 

(3.3.10 . 

C I 706800 


X IC 

(2.3. 10) 


XMAS 

(10) 


XMN 

( 23. 33) 


XMT 

(3.3.10 . 

C 1 706900 


TUG 

(23) 


FLA 

( 3.20 


FL G 

(3.20) 


FLC 

(3.20) . 

Cl 707000 


FLD 

12.3,20) 


FL J 

(3,3.20 ) 


C AO 

(3.10) 


XIU 

(3,3 .1C). 

C 1707100 


FL IRC 

12. 10) 


FLCMC 

(2.10 


F LAC 

(3,20) 


FLOC 

(3.20) , 

C 1 707200 


FLCN 

( 20 ) 


ZETA 

( 20 > 


FCF 

(3,3.40) 


FCK 

(3.40) • 

C 1 7C7300 


4 . T IMENQ 


CCMMCN /REAL Z/ 

* CEDLM (1.3J 

* XMCCLM( 1,1,9) 


CCMMCN- / S ATE LL / 
* D LM M V ( 1 COO) 


ce 

XMC 


(3.10 

(3.3.10) 


C6COUM( 1,3) 
CdN( 3) 


C3C 


(3.10) 


EQLI VALENCE 


(ETM( 1 ).THADC( l )) 

( X MN ( 1.3). YMCC (1.1.1)) 

( XMN ( 1 ,6 ) .ET IC ( 1 . 1 ) ) 

( FLti ( 1.1) .FLC( 1 . 1) ) 
(FLH( l . 1 , 1 ) ,FL J( 1 . I . I ) ) 
(FGI . L INI T( 1 ) ) 

(CBDUMU .1 ) .HIMTd )) 

( SCNOUM. I7IMKD) 


... ( XMN ( 1,1). ANGC ( 1 ) ) . 

.' ( XMN ( 1.6). CNF (1,1)) . 

, (XMN ( 1 , 1 0 > ,ETMC( 1 , 1 ) ) • 

. (FLfc (1.1.1) • FLD ( 1.1.1) ) , 
• 

, ( C A ( 1 .1 ) .R IN1T ( 1 ) ) 

, ( A»0RK( 1 ) . I INI T ( 1 ) ) 


ECLIVALENCE (L TORCU.LECL ) 
CIMEMSICn Y(NEO) . YC(NEC) 


NEOD = 
Ndl a 
M = 
K- 1 = 

JCCN(K ) = 
K = 

RELC(K) = 
XM A S ( X ) a 
X IC ( I . J . X ) = 

* 1 1 CF C ( I . M ) = 

TH/ ( M ) a 
TFAC(M) = 
PH K I . FBI ) = 
PH I ( 1 ,X ) = 


SYMECL LISTING UF PARAMETERS USED FRCM COMMON 

TCTAL NUMBER CF RIGIO BOCIES AND POINT MASSES 
N BUD ♦ 1 

GIMBAL AXIS LABEL 

HINGE FCINT AT *K1CH GIMBAL AXIS M IS LOCATED 
LABEL CF ROCY INBOARD OF HINGE PONT X - 1 
LABEL CF BODY C L T GO AH D UF HINGE POINT K-l 
TRUE IF BODY K IS A RIGID BJDY-, FALSE CThERMlSF 
MASS OF 'BODY K . (M) 

INERTIA TEN SC F OF BUOY 'K ABOUT ITS CENTER OF MASS 
RELATIVE TO FRAME CJF COMPUTATION, (M*L**2> f 
COMPONENTS R6L AT I VE 'f'U Gee'MPLiTING'C'FR^ME OF UNIT 
VECTOR ALONG GIMBAL AXIS M 
DISPLACEMENT ABCLT UR ALONG GIMBAL AXIS M (R UR L) 

RATE AECUT OR ALONG GIMEAL AXIS M (R/T OR L/ T ) 
RESULTANT EXTERNAL FURCE ACTING CN COMPOSITE SYSTEM CM 
RESULTANT EXTERNAL TURUUE UN NEST X- 1 


Cl 7C7A00 
Cl 707500 
Cl 707600 
Cl 7 C 77 00 
Cl 7C7800 
C I 707900 
C 1 708000 
C l 708 1 00 
C I 7C8200 
C I 7C8300 
C I 708400 
( I 7C8500 
C 1 708600 
Cl 7C8700 
Cl 7C8800 
Cl 7 C 8900 
C 1 709000 
C l 7C91 00 
Cl 709200 
Cl 709300 
C 1 7C9400 
Cl 709500 
Cl 7C9600 
C 1709700 
Cl 709800 
C 1 70990C 
C 1 71 0000 
C 1 71 01 00 
C 1 710200 
C 1 71 0300 
C 1710 400 
Cl 71 0500 
Cl 71 C 6 00 
Cl 710700 
C 1 71 0800 
C 1 71 0900 
Cl 7 1 1 C 0 C 
0 711100 
Cl 71 I20C 
Cl 71 1 30C 
0 711 400 
Cl 71 1500 
Cl 71 1 60C 
Cl 71 l 700 
.0 71 1 800 
Cl 71 1900 


A-102 
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c 

c 

c 

‘c o 

c 

c . 

c 

c 

c 

c 

C , : 

. C 

c 

c . 

c .. 

c ' 
c 
c 
c 

C . ; 

c . ; 

c 

c 

c 


NO 
H.KCl I 


Mi 
(N« > 
• Mi > 


.GAM < I ,KL ) = 


SK ( 
SMC ( 
XMCC X . 
XMC( I , 


. c. 
c - ' 

c. 

c 

c . 

-c >' 

•"C’.I. 

O 

c 

x« 

"e - 

c ■ 
c 

c ‘ 

c 

c 


K- 1 ) 
K- 1 ) 
J .L ) 
. .0 ) 
Y 
YD 
NEC 


MOMENTUM WH EE 
bliOY IN iHICh 
COMPONENT S OF 
(RELATIVE TO 
COMPONENTS CF 
MASS OF BUOY 
CODED WCRO. A 
CODED »CRD. A 
‘ TRANSF CRMAT 10 

transfcrmat ic 
SOLUTION ARRA 
.EQUATION APR A 
NUMBER OF FIR 
OUTSIDE OF SL 


L LAeEL 

MOMENTUM WHEEL Mi IS EMBEDDED 
UNIT VECTOR ALONG SPIN AXIS OF WHEEL M 
COMPUTING FRAME) ’ 

VECTOR FRCM HINGE PCI NT K-l TO CENTER 
L. WHERE K.L = KT01NB1.K-1 »L ) 

LL ECDIES IN NEST N-l 
LL MOMENTUM WHEELS IN NEST K-I 
N MATRIX. BODY L TO COMPUTING FRAME' 

N MATRIX. 'INERTIAL TO C OMPU T 1 NG >FR A M E 
yV CONTAINS INTEGRATED PARAMETERS' 

Y. SENT TO fiUNGE FOR INTEGRATION; 

ST ORDER DIFFERENTIAL EQU A T IONS • DEF INEC 
ERCLTINC TuRQUE 


OF 


THE 

1 


let: 

.• .SP 

: CP 
CL 


INPUT OF USER REQUIRED DATA FOR SUBROUTINE TORCUE 

USER MAY APPLY CNE OF THREE OPTIONS 
) PREFERABLE. DEFINE ALL USER REUUIRED DATA ON 
•DATA • CARDS WITHIN SUBROUTINE TORQUE 
) WRITE SUBROUTINE INTOR AND PASS ALL USER REQUIRED C 
THROUGH CCMMCN IN /SATEuL/ 

) READ INPUT CATA ON FIRST PASS THROUGH TORQUE 
CT4 = l CN FIRST PASS THROUGH. STORE DATA 

IN /SATELL/ - 


REACTION TCRQCE ACTING ACROSS OR ALONG G I ME AL AXIS 
AT HINGE PCI NT K.-1 DUE TO': ' ' ’ ' 

LINEAR SPRINGS 

LINEAR VISCCUS DAMPERS ' 1 

MOTORS 

R ( M ) = SPRING CONSTANT AeOUT OK ALJNG GIMBAL AXIS M' 
(M*L**2/T*«2 CR M/T**2> 

C(M) = DAMPING CONSTANT ABOUT OR ALONG OIMuAL AXIS M 
,.CM*L**2/T CR. M/T) 

TXM) = CONTROL TORCUE AFPLIEDBY MOTOR ABOUT CR ALONG GIMEAl 
AXIS M M*L«42/T**2 OR M*L/T«*2 


I JVI 3. 


c 

c 


C' 

c 

7 ! U 


.=)() 


DIMENSION TEM(J) 

SPR INC TORQUE ' 

SPR ( M ) = USER INPUT 
A = SFR(M)*THA(M) 

CALL, ,SCL V(_A.QFC( 1 ,M) ,TEM) , . . 

CALL VECSUdlPHI ( l ,K). ,TEM .PHI l 1 ,K ) > 
:DAMFE P TGRUUE 

CPC(M) - USER. INPUT ■ 

SAl A=-l -C ZCl H I/f> 3V1T 4 j » M.T « OR :■> ) j 

CALL SCLV(m,OFC( l.M) ,TEM) 

CALL VECSLB1PHI I 1 ,K) .TEM.PHI ( 1 ,K ) ) 
MOTCR TORQUE 

CLT(M) = FUNCTION OF STATE VARIABLES. 
CALL SCLVCCLT(M) ,QFC( I ,M) .TEM) 

CALL VEC ADD ( PH I ( l ,K> .TEM.PHI ( 1 .K ) ) 


LSER DEF 


Cl 
C I 
C 1 
Cl 
C I 
Cl 
Cl 
Cl 
C 1 
Cl 
ci 
Cl 
Cl 
C 1 
Cl 
Cl 
C 1 
' Cl 
Cl 
"C 1 
Cl 
C 1 
ATAC 1 
C 1 
CI 
Cl 
Cl 
C 1 
C 1 
c i 
ci 
ci 

s MCI 
ci 
c 1 
'ci 

Cl 
C l 

c 1 

Cl 
Cl 
C 1 
C 1 
C 1 
Cl 
Cl 
Cl 
Cl 
Cl 
C l 

ci 

. C 1 
C 1 

iC! 

C 1 
C 1 
C 1 
.C 1 
C 1 
Cl 


712000 
712100 
7122C0 
712300 
71 2400 
71 2500 
71 2600 
712700 
712800 
71 2900 
71 3000 
71 3100 
713200 
713300 
713400 
71 3500 
713600 
71 3700 
71 3800 
713900 
71 4000 
714100 
71 4200 
714300 
714400 
71 4500 
71 4600 
71 4700 
71 4800 
71 4900 
715000 
71 51 00 
71 5200 
71 5300 
71 5400 
715500 
71 5600 
715700 
715800 
71 5900 
71 6000 
716100 
716200 
71 6300 
716400 
71 6500 
716600 
71 67C0 
716800 
71 6900 
717000 
71 7100 
717200 
71 7300 
71 7400 
717500 
71 7600 
717700 
71 7800 
71 7900 
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n rv 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

C ■ 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 


let: 

CLM IMw ) 


let: 

J 

L 

R JI I 1 
F J( I ) 


c 

c 


CRAV 

BK1I 


REACTION TCRQLES ON SYSTEM DUE TO A CONTROL TORCUE 
APFLIEO TC MOMENTUM WHEEL MW 

= CONTROL T OR CUE APPLIED TO WHEEL MW ABOUT ITS SPIN AXIS 
USER DEFINEC FUNCTION GF STATE VARIABLES ( M»L * *2 / T * * 2 ) 

C CL M ( M ¥ ) = USER DEFINED FUNCTION OF STATE VAR6. 


REACTION TCRCLES JN SYSTEM DUE TO A LOCALLY 
APFLIEO E > TERNAL FORCE (I.E. A GAS JET) 

= INTEGER LABEL ASSIGNED TO GAS JET 
= BODY TO WHICH EXTERNAL FORCE DIRECTLY APPLIED 
= RADIUS VECTOR FPCW CENTER OF MASS OF BODY L TO 

GAS JET J, ( COMPONENT S RELATIVE TO dODY L COORDINATES) 
= COMPONENTS OF APFLIEO FORCE DUE TO GAS JET J, (RELATVE 
TO BODY L C C CRD I NATES) USER DEFINED FUNCTION OF STATE 
VARIABLES IW*L/T**2) 

DIMENSION R JC I 3 I.FJC(J) ,TEM(J) »TEM 1 l 3) ,RJ(3) ,FJ(3) 

INTEGER SU101.NS1 

LOGICAL CTAIN 

R J( I ) = LSER INFLT 

CALL VECTRNIRJ . XMC( I . I ,L) ,RJC) 

FJII) = LSER DEFINED FUNCTION OF STATE VARIABLES 
CALL VECTRNilF J , XWCt 1 , I ,L) ,F JC ) 

CALL VECADOIPHI (1. Nei) ,FJC. PH 1(1. NE1)) 

00 3 K=l,N30D 

CALL UNP AC I SI .NS 1 . SKI K- l ) ) 

IF1 .NOT .CTAINIL tSl *NSl ) ) SO TO 3 
IFIRBLOIK)) GC TC 4 

CALL VECADOIPHI I 1 . K ) , F JC . PH I I l .K) ) 

GO TO 3 

KL = KT0INB1 .K-l ,L) 

CALL VECACDIGAM II . KL ) .RJC.TEM) 

CALL VECRCS I TEW .F JC . TEM1 ) 

CALL VECADOIPHI I 1 .K) #TEM1 .PHI I 1 • K ) ) 

CONTINUE 


t 


REACTION TCRQLES "ON : S YSTEM DU E To' ' GR A V I T AT I CN AL 
EFFECTS CN AN EARTH EASED SYSTEM 

= ACCELERATION CF GRAVITY IL/T*»2) 

= CCMFUNENTS OF LNIT VECTOR FROM INERTIAL ORIGIN TC CC VP . 
SYSTEM CENTER OF MASS. IRELATIVE TU INERTIAL FRAME) 


C I 71 6000 
C l 718 100 
C 1 71 8200 
Cl 71 8300 
Cl 71 E400 
0716500 
C 1 71 860C 
Cl 718700 

c i 7i eeoo 
c i 7i esoe 

Cl 719000 
0 719 100 
Cl 719200 
Cl 71 9300 
C 1719400 
C 1 719500 
Cl 719600 
C 1719700 
C 1 71 9800 
Cl 71 9900 
Cl 720000 
C 1 720100 
C 1 720200 
C I 72C300 
C 1 720400 
C 1 720500 
C 1 720600 
C 1 720700 
C 1 720800 
C 1 720900 
C 1 721000 
C 1721 100 
C 1 72 1 200 
C I 721 30C 
C 1 721 4C0 
Cl 721500 
0721600 
Cl 721700 
Cl 721800 
C 1 721900 
Cl 722000 
C 1722100 
C 1 722200 
Cl 722300 
C 1 722400 
C 1 722500 
C 1 722600 
Cl 722700 
Cl 722800 
C 1 722900 
Cl 723000 
C 1 723100 
C 1723200 
Cl 723300 
Cl 723400 
Cl 723500 
C 1 723600 
C 1 723700 
Cl 723800 
C 1 723900 
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C THAT IS. PARALLEL TO DIRcCTICN OF GRAVITY forcf. 

c 

C INTEGER SM101.NS1 

C DIMENSION TEMl 2 ) ,BFC( 3) .HH( 3) 

C C BH( I ) = LSER INFOT 

C CALL VECTRNI3F ,XMC< 1 . I .0) ,BHC) 

C DO A X=l.NBOC 

C C GRAV = LSEfi INPLT 

C A = XMAS(K)*GRAV 

CALL SCLVI A.BFC .TEM) 

CALL VECSLBIPHI ( 1 ,NB1 J ,TEM .PHI ( I ,Ncl ) ) 

IFI RBLOI K) ). GC TO S 

CALL VECSOBIPHI ( 1 » K ) .TEM.PHII 1 ,K) ) 

GO TO 4 

5 CALL UNPACI SI .NS1 .SKIK-l ) i 
DO 4 LL=1.NS1 
L = SI ILL) 

KL = KTO (N8 l .K- 1 ,L ) 

A = XMAS (L 1 *GR A V 
CALL SCLV(A.BHC.TEM) 

CALL VECRCS ( G A MI 1 .KL ) . TcM . Tfe Ml ) 

CALL VECSLEIPHII l . K ) .TEMl ,PHl( l , K) ) 

4 CONTINUE 


C t 7240C0 
C 1 724 1 00 
C 1 724200 
C 1 724300 
C 1724400 
Cl 724500 
C 1 724600 
C 1 724700 
C 1 724800 
C 1 724900 
Cl 72500C 
C 1 72S 100 
C 1 725200 
0 l 725300 
C 1 725400 
Cl 725500 
C 1 725600 
Cl 725700 
C 1 725600 
Cl 72 590 0 
Cl 726000 
C 1726100 
C 1 726200 
C 1 726300 
Cl 726400 
C 1 726500 
C 1 726600 


KEPLER I AN CRB I T 

COMPONENTS CF VECTOR FROM EARTH* S CENTER TO COMPOSITE 
SYSTEM CENTER OF MASS. RELATIVE TO INERTIAL REFERENCE 
FRAME, ORBIT ASSUMED TO BE IN INERTIAL 2-3 PLANE 
SEMI-MAJOR AXIS CF ELLIPTIC ORBIT INERTIAL 2 DIRECTION 
ORBIT ECCENTRICITY . ^ 

time of perihelion passage, i t > 

EARTH'S GRAVITATIONAL CONSTANT, IL**3/T**2> 

MEAN MCTICN 
MEAN ANOMALY 
ECCENTRIC ANOMALY 
TRUE ANOMALY 

MAGNITUDE OF CE(I.O), (L) 


= USER INPUT 
= USER INPUT 
= I ./SORT! ASM**3/GEV> 

= USER INPUT 
= ETE*(T— TFF) 

= SINIAME) I SM4 = S I N( 4*AME ) 

= S I M2* AME > 

» SI N ( 3 * A M E ) 

= USER INPUT 

= AME ♦ ECC»SM1 * ECC**2*SM2/2 
+ECC**3*(9*SM3 - 3*SMl)/(24) 
+ECC**4*(64*SM4 - 32*SM2)/192 
= COS(ECE) 

= SI NIECE) 

= ASM*< l - ECC»CE ) 
l . 0 ) = 0 


0 1 726700 
C I 726600 
C l 726900 
C 1 727000 
C 1 727100 
C 1 727200 
C I 727300 
C 1 727400 
C 1727500 
C I 727600 
C 1 727700 
Cl 727800 
Cl 727900 
Cl 726000 

Cl 72ei00 

C 1 728200 
C 1 72 830 0 
C 1 728400 
C 1 728500 
C 1 728600 
C 1 728700 
C I 728800 
C 1728900 
C l 729000 
.1729100 
C 1 729200 
C I 729300 
C 1 72940C 
C 1 729500 
C 1 729600 
C 1 729700 
C 1 729800 
C I 729900 
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n n o a n n 


C 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c ; 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c~ 

c 

c 

c 

c 

c 


Cat 2*0) = BTOWIICE- ECC)/(i - ECC*C£>> , 
C8IJ.0) = BTO*< SORT ( 1 -ECC**2 ) *S£/( 1 -ECC*CE ) 1 

CALL VECTPMCEC 1 .0 ) .XMC( 1 . 1 ,0 ) .CBC( 1 . 0 ) ) 


REACTION TCSOLES CN UROITING SYSTEM DUE TO 
GRAVI TY' GRADIENT EFFECTS 


let: 

.CSC! 


* NCT 

* C £ ( 
A APE 

* OF 
A TEE 

* ,CM 
A CRl 

B 


OF G ( 
"SG 


I .< ) 

C( I ) 


C 1 730000 
C I 730100 
C 1730200 
C 1 730300 
C1730400 
Cl 730500 
C 1 730600 
C 1 730700 
Cl 730800 
C l 730900 
Cl 731000 
C1731 100 
C i 731200 
C 1 73 1 300 
0731400 
Cl 731500 
C 1731600 
C 1 731700 
C 1 731 800 
C 1 731900 
Cl 732000 
C 1 732 100 
C 1 732200 
C 1 73230C 
Cl 732400 
Cl 732500 
C173260C 


1.1) = COMPONENTS CF VECTOR FROM COMPOSITE SYSTEM CENTER OF 
MASS' TC CENTER CF MASS OF BUD Y 1 , ' RE L A T I VE TO 
COMFUT ING FRAME 
E FOR GRAVITY GRAD I E NT OPTION 
1.1) AND ITS INERTIAL DERIVATIVE 
REDEFINED TO CIRCUMVENT DIFFERENCE ‘ 

LARGE NUMBER PROBLEMS, THAT IS 
V AHfc MEASURED FROM COMPOSITE CM TO 
CF eCDY 1 RATHER THAN FRCM INERTIAL 
CIN TO CM OF BCD Y 1 

HI) = UNIT VECTOR FRCM EARTH'S CENTER Tu’ SYSTEM COMPOSITE 

CENTER CF MASS. COMPONENTS RELATIVE TO INERTIAL FRAME 
.CELtl.N) = COMPONENTS CF VECTOR FRCM COMPOSITE SYSTEM CENTER CF 
• MASS TO CENTER OF MASS CF BUOY K 

COMPONENTS CF GRAVITY GRADIENT FORCE ACTING ON BOCY K 
COMPACTED INTEGER WORD. THOSE BODIES IN THE NEST I 
WHICH SIGNIFICANTLY CONTRIBUTE TC GRAVITY GRADIENT EFF.CI7327C0 
BTC = DISTANCE FRCM EARTH'S CENTER TO COMPOSITE SYSTEM CM Cl 732800 

C 1 732900 

DIMENSION DEL ( 3 , 10 ) .DFGI 3 . 10 ) , JHC ( 3 ) . BH I 3 ) . T EM ( 3 ) . TE M 1 l 3 ) C 1 7 3 30 00 
INTEGER SGGIC. 9 ). SIC 101 0733106 

C KEPLERIAN OfiSlT MUST dfc USED WITH GRAVITY GRADIENT CF T ION C 1 733200 

DO 1 C I = 1 . 3 Cl 733300 

, 1 C QHC(I) = CBCII.O/ETO C 1 733400 

DO 7 K=l.NHOC C I 733500 

KL = KTOINBl.C.K) C 1 733600 

CALL VEC ADD (CeC ( 1 . 1 ) . GAM( I ,KL ) .DEL ( I ,K ) ) 01733700 

CALL VcCOOTI BHC .CELIl .K) , A) 0733800 

A = 3 *A Cl 733900 

CALL SCLVIA. 3 HC.TEM) Cl 734000 . 

CALL VEC SUB < DEL I l J ,N) • TEM, TEM) 0734100 - 

A = -GEVOMASIK )/BT 0**3 0734200 : 

CALL ' SCL VI A . TEM .DFG < l.K ) ) 0734300 

7 CONTINUE ... 0734400 : 

DO d ‘ K= 1 .~NBGD 0 734500 

IFIRBLO(K)) GC TC 9 ' • 0734600 - 

call vec add (phi i i . k) ,ofg< i .n> .phi i i ,k > ) 0734700 . 

■ GO TO. 8- ' 0 734800 . 

C SGGII) = SK(I) IF ALL BODIES CONTRIBUTE TO GRAVITY GRAC. 0734900 

C EFFECTS. IF' NOT USE COMPAC TO CONSTRUCT 0 735000 

C * r - 1 SGGII ) ! "FORM-USER INPUT OR DEF IN E "C I R ECTL'Y ~C 1 73S 1 00 ' 

9 CALL UNPACI ST .NSI .SGGIK-l ) ) ' ■ 0735200. 

00 8 LL = 1.NS1 0735300 

‘ ' £.'• = ' s I ( : L li FiUJilEUH I- U J lie. . J 1 oOii JtMMj H *' - t A ) 2 r 0735400 3 

KL = KT0INB1 .K-l.L) ’ 0735500 

CALL VECRCS ( G A M ( I ,KL ) .DFG ( I .L ) . TE M ) 0735600 

CALL VXD YCVl BFC .X IC( 1 .1 ,L ) .TEMl ) 0 735700 

A -= 3*GEV/eTC**3‘ 0 735800 

CALL SCL VI A , TEM 1 , TEMl ) Cl 735900 


A-106 


nnonnoonnnnnnAnonnnnnnnnonnnnnnnnnnnnnnnnnnnonn 


c 

c 

c 

c 


c :: r > 

c 

C .0> 

c '.io ■» 

c 

c 

c 

c 

C ■ 


CALL VECACC ( TEX ,1EM . TEM) 

CALL VECACD(PhI(l . K) . TEM, PHI ( l ,K) ) 
6 CONTINUE 


parameters cefineo ar first order 

DIFFERENTIAL EQUATIONS 

T: , . 
NTC = TOTAL number cf first OkCCR differential equations TC 

BE SOLVED FOR LSE IN SUBROUTINE TORQUE 
TC(N) = MAGMTLCE OF FAR AME TER NUMBER N CEFINED »ITHIN SLE. 
TORQUE AT TIME T 

TOC I N ) = TIME DERIVATIVE CF PARAMETER TU I N ) • A USER DEFINEC 
FUNCTION OF TFE SYSTEM'S STATE VARIABLES 

DIMENSION TQI20) ,T0D<20>. ' ' " ‘ 

C FOR TFE PARAMETER N ' 

lFICTA.NE.il jO TO 11 

C YINEQ+N) = TO(N> = INITIAL VALOt FOR TC ( N ) 

11 TC ( N ) = Y < NEJAN ) 

C TOD(N) = USER DEFINED FUNCTION OF STATE VARB. 

c 

C AFTER CEFINITION OF LAST DIFFERENTIAL EGLATICN 

C NTQ = TOTAL number of first order differential 

C EOLATIONS TO BE SOLVED FOR USE IN TCfiOUE 

. DO 12 N= 1 . NTO 

12 YCINEC + M = TOD1N) 


. JHi 


ASSUME 


let: 


thermally inolchd motion ABOUT 0 1 MO AL AXIS M 
AT’ HINGE POINT K.-1 

ALL THERMALLY INOLCED OEFlECTIJN IS SMALL ANGLE.' 

RELATIVE TO TFE SYSTEM'S NOMINAL ZERO STRESS STATE 
THERMALLY INDUCED DEFLECTION IS MODELLED AS A MOVEMENT 
OF THE ZERO STRESS STATE 

ACROSS ALL HINGE POINTS SUBJECT Tj THERMAL DEFORMATION 
SPRINGS AND CAMPERS ACT 

A RESONAOLE MODEL CF THE THERMAL INPUT CAN BE DEFINEC 
IN TERMS CF TFE SYSTEM'S STATE VARIABLES 
THERMAL EQUILIHRILM POSITION AJOUT ANY GIMBAL AXIS IS CE F . 
BY SOLUTION OF THE HEAT CONDUCTION EQUATION 



- SFR( M ) 
DFO(K) 
•T A 0 ( M ) 

13 TC(N) 

TCC (N ) 

T 1NP = 


=. SPRING CONSTANT ACROSS GIMBAL AXIS M 
= DAMPING CONSTANT ACROSS GIMBAL AXIS M 

= thermal time constant for deformation about gimeal . 

AX IS M, ( T ) 

= THERMAL EQUILIBRIUM FOSITIUN FOR THERMAL DEF,OF.M/>T IC N 
ABOUT GIMBAL AXIS M, {RADI ‘ 

RATE OF CHANGE CF THERMAL EQUILIBRIUM POSITION AEOUT 
GIMBAL AXIS M, FIRST ORDER DIFF. EQ • . ( RAD/T ) 

THERMAL INPUT USER DEFINED FUNCTION UF STATE. VARIABLES 
(RAD/T) 


C I 736000 
C 1736100 
0 1 736200 
C 1 736300 
C 1 736400 
Cl 736500 
C 1 736600 
0 1 736700 
C l 736800 
C 1 736900 
C 1 737000 
C 1737100 
C l 737200 
C l 7373^0 
C l 737400 
C 1737500 
C 1 737600 
Cl 737700 
C l 737800 
C 1 737900 
C l 738000 
C 1 738100 
C 1 738200 
Cl 738300 
C 1 738400 
Cl 738500 
C 1 738600 
Cl 738700 
Cl 738800 
C l 738900 
C I 739000 
C 1 739100 
C 1 739200 
C 1 739300 
C 1 739400 
C l 739500 
C 1739600 
Cl 739700 
C l 739800 
C 1 739900 
C 1 740000 
C 1 740100 
C 1740200 
Cl 740300 
C 1 740400 
Cl 740500 
Cl 74 0600 
C 1 74 C 700 
C 1 74080C 
C 1 740900 
C 1 74 I 000 
Cl 741 100 
C 1 74 I 200 
C I 74 l 300 
C l 74 1 400 
C 1 741500 
Cl 74 1600 
C 1 74 1.700 
C 1 74 1 BOO 
C 1 74 1 900 


A-107, 



o.n nnnnnpnnnn n __ n • . nonnrvnnnnpnnnnnnnnnnnn.nnnn 


DIMENSION, TEMC2 ) ■ . ■ - • 

C N = USER DEFINED LAHtLi DEPENDS UPON EQUATItN NUMBERING 

C SEQUENCE DEFINED rtITHIN .SUBROUTINE , TORQUE 

IFICT4.NE.1) GO TG 13 

C Y1NEQ+N) = TO ( N ) = INITIAL VALUE F CR THERMAL DEFCR M A T I CN 

C ABOUT GIMBAL AXIS M, USER INPUT 

1 2 TQl N) = . V (NEC + N I 

C TINP ,= USER DEFINEC THERMAL INPUT. FUR THERMAL CEFCRMAT IGN 

C ABCUT GINEAL AXIS M 

C TAU(M) = 'L SEP INPUT . , 

TOD.(N) = -TO(N>/TAL(M) + TINP 
A = SPK( M)*< THA (Ml - TQ(NI) ■ . 

CALL- S.CLW A. OFC (1 . M I . TEM) - • 

CALL VECSLB(PhI ( 1 ,K> .TEM.PHI ( 1 .K> 1 . ’ 

A ,= , DPC( K 1*THAC (MI . 

CALL SCLV(A,QFC(1 .Ml ,TEM> 

CALL VEC SUB (PHI { 1 .K 1 . TEM.PHI ( 1 .XI) . .. 


ZERO ALL ELEMENTS CF EXTERNAL TORQUE MATRIX 
CO 1 K = l . Nd 1 
,CC 1 I = 1 . J 

1 PHKIiO = O.DO 
CO, 2 M = 1 .NMO 

2 ‘ CLM Ml = O.DO 

.RETURN 

END 


C l 742000 
C l 742 100 
C l 742200 
C l 742300 
C 1 742400 
Cl 742500 
C 1 742600 
Cl 742700 
Cl 742eOC 
Cl 742900 
C l 743000 
Cl 74 3 100 
C l 743200 
C 1 7,43300 
C 1 743400 
C l 743500 
C 1 743600 
C.l 74 3700 
Cl 74 3 8 0 0 
C 1 7439CC 
C 1 744000 
Cl 744100 
C 1 744200 
C 1 744300 
C 1 744400 
C 1 744S00 
C 1 744600 
C 1 744700 
C 1 7448C0 
C 1 744900 
C l 745000 
C I 745100 
C I 745200 
C 1 745300 


SUERCUTINE QFDCT 

L 5 ED TC REDUCE. TEE SET CF NrfJO+UNMV VECTOR DYACIC EQUATIONS 
M C T I CN TO NFER+NMV SCALAR EQUATIONS - • 

LET - ' - 

SCF(K) = LOWEST MAGNITUDE FREE COORDINATE INDICE AT HINGE 
POINT K-I. EQUALS ZERU IF THREE CUNSTRAINTEC AXES 
SCL(K) = LOWEST MAGNITUDE LOCKED COORDINATE INDICE AT HINGE 
POINT K- 1 . ECUALS ZERO IF THREE FREE AXES 
SCK(K) = .BODY LABELS CN PATH FROM HINGE POINT ZERO TO C.M. 
r . ■' ‘ 'of BUOY K. FOR' K = NBl IT IS SET OF ALL ECDY LABELS 

IMPLICIT REAL*8( A -H.O-Z . S I 


CF 


LOGICAL 
LOG I GAL 


FGI 


•Fj • 

FG2 . FG3, 
LNLNGE 
LTRANV 
LGFDOT 


101) 

FG4 , Fib. 
. LTRNSI i 
, LR ATE . 
. LDCT , 


) 


1 :«<= 


) 


INERF. RBLO. LEQU * LlNITdl 

lvoiv . leqoiv ltran . 

LXOY . LETA . LTOPQU . 

LANGLE . L SETUP' .» LSIMQ 


C 

C 


ci eooooc 
c leooioo, 
C 1 B00200 
C 1 f 00300 
C 1 800400 
C 1 8005CC 
Cl 800600 
c i eoo70o 
c i eooeoo 

C 1 8C0900 

cieoiooo 
cieouoo 
c i eoi 200 
cieoi3co 
v c leoi 400 

C 1 80 1 500 

cieoieoc 
c i eci 700 
c i eoi eoo 

C18C19C0 

c ieo 2 oco 


A-108 


uu uuuu l» l> 



INIECEH 










0602100 

* 

AfcOFK. 

. CTl 

. CT2 . 

CT 2 

• CT* 


CT 5 t 

fcon 

. PC C N 

9 

Cie02200 

♦ 

SCNCUM 

. SCN 

• SCRDUM • 

SCR 

• SFKDJM 


SF K * 

SFR 

. SO 

• 

Cl 602300 


S I 

. SIG 

• SIXDUM.- 

SI X 

, SKDUM 


SK • 

SL 

. SL K 

• 

0602000 

* 

SMA SMCOUM 

. SMC , 

S MV 

• SOK 


SPIDUM, 

SPI 

i , .SQF 


0802500 

* 

SCL 

. SR 

. SSCN- ~\. 

S S IX 

* SVA t 


S y a • 

SVC 

. sv i 

* 

C 1602600 

♦ 

S VM 

. S VP 

* SVG .. 

SXK 

• SXT 


T GRG * . 

SMAL 

. SEU 

9 

C 1 e02700 

* 

sc 

. SCG 

f NFL XB . 

SFLX 

. SF X p 


NMCOS • 

SFCC 

.sec 

* 

C 1 602800 

* 

I INIT< u 

. . I Z I N I T < 1 1 

• SD 


SCXC<20 J 




C 1 e02900 












C 1 803000 









, ' ' 



0803100 


RE AL *8 




, 


• .* ^ v : . 




C 1 603200 

* 

ANGC 

(33) 

. CNF ( 

3.10 

* ETIC 

(3.10) . 

ETMC 

(3.10) 

* 

• C 1 603300 

* 

FLQ 

(3.20) 

. FLE (3.3.20) 

• Fi_H 

(3.3,20) , 




C 1 603000 

* 

TFACD 

( 33) 

. ymcd ( 

3.2 .11 ) 

• RIMT 

( 1 ) . 

RZ1N IT lit 


0 603500 








- 




C l 603600 


. 




, . 






C 1 e03700 


COMMCN 

/LDEBUG/ 

lrlnge . 

LTRNSI 

* LVDlV 


• LEGU.IV 

. . LTR AN . 


Cl 603800 

* 



LTRANV * 

LRATE 

. LXDY 


• LETA 

- . L TOR QU . 


C l 803900 

* 



LCFDOT , 

LDCT 

» LANGLE 

• L SE TUP 

. LS1MQ 


Cl 8000.00 


Cl 800.1 00 
C 1800200 


COMMON /LOGIC/ FGI, FGZ, FG3 • FG4, FG5. INERF. RdLJ(lO) 0600300 

C 1 600000 
ciebosoo 

CCMMCN /INTG/ A*ORM2CO) . „ C160O600 



C T 1 


9 

CT2 


. CT3 


. CTO 


. 0600700 


C T5 


• 

FCON 

( 33 ) 

. JCCN 

( 10 ) 

. LCON 

(22 ) 

. 0800800 


MC 

( 10) 

* 

Nfcl 


. Msaj 


. NCTC 


. 0 800900 


NFER 


* 

NFKC 


. NFRC 


. NLOR 


. cieosooo 


NM V 


• 

NMC 


. NMOA 


• NSVP 


. 0 805100 


NS VC 


• 

PCON 

< 11 ) 

. SD 


, SFR 

(33) 

. Cie05200 


SG 


• 

S 1 

( 55 ) 

. SIG 


. SL 


, 0605300 


SLK 

( 33) 

• 

SMA 

( 10 ) 

. SDK 

111) 

. SQF 

(11) 

. 0 605000 


SCL 

(11) 

* 

SM V 


« Sw 


. SSCN 


. 0 805500 


S S IX 


• 

SVA 


. SVd 


. SVD 


. C16C56C0 


SV I 


9 

S V M 


. SVP 

(22) 

. SVC 

( 33 > 

. 0605700 


S XM 

(3.10) 

• 

SXT 


, TORO 

(97) 

. SMAL 


. Cie05800 


SEU 



NTQ 


. SC 

(33) 

. SCG 


. cieosooo 


NFL xa 


• 

SFLX 


. SF XM . 

(10) 

, NMCDS 


. cieo 60 oo 


* SFCC . SCC (1C) 0806100 

Cie06200 

. C ieC6300 

ccmmcn /intgz/ cieceooo 


* SCNCUM 


. 

SCN 

( 9 ) 

• 

SCRDUM 


9 

SCR 

(9) 

9 

C ie06500 

* SFKCUM 


• 

sfk 

( 91 

• 

5 I XOUM 


9 

SIX 

(9) 

9 

C 1 8066C0 

* SKDLM 


• 

SK 

(9) 

• 

SP IDUM 


9 

SPI 

(9) 

9 

c i eo67co 

* SMC CUM 


9 

SMC 

(9) 








Cl 806800 

C 












0806900 

C : 












c i eo7ooo 

♦ : ; ,-CP.MMCN 

■* CA 

/REAL/;, f 
(3,10.) 


* . • '1 

CA C* 

' . I '-1 $Cr 1 

13. 1.0) 

L- 

* x 

V. ' ,•/ 

CL M 

. 

( 1 .0 ) . 


-K.j < 

CLM.C 

'i'3 .1 1') ' " 


C 16071 00 
C ie07200 

, . * DCMC 

(3.11) 


ETC 

(3.11) 

• 

ETM 

(33). . 


FUMC. 

(3 .11). 


C16C7300 

v ' . ;G'AM 

(3,60) 


F 


• 

HM 

(3.10) 


HMC ' 

(3.10) - 


cieo7aoo 

A J :* |H M 0 M 

( 1C) 


PFI 

(3.11) 

9 

PL M 

(10) 


GF 

(3.33 ) 


Cl 607500 

* QFC 

(3.33 ) 


QL . 

(3.22) 

9 

QLC 

(3.22) 


RQMC 

(3.11) 


Cl 6C7600 

* T 






THA 

( 33) 


THAO 

<3 3) 


C l 607700 

* TFACw 

( 10 ) 


THAW 

,( 10 ) 

9 

XO IC 

(3.3,66) 


XI 

(3.3.10 


C l 607800 

♦ x ic 

13.3.10) 


XMAS 

(1C) 

9 

XMN 

(33.33) 


XMT 

(3.3.10 


- Cl eC7900 

♦ TLG 

( 33) 


FLA 

(3,20) 

9 

FLG 

(3.20) 


FLC 

( 3.20 ) 


Cl 608000 


At109 



o u u u 


c 

c 

c 

c 


c 

c 

c 


* FLO (:• J.20I. FLJ (2.3.20). CAC (3.10) . XXO <3.3.10, 

* FLIHC (3.10) . FLCRC (3.10 . FLAC (3.20) . FLQC (3.20 . 

* FLC* (2C) . ZETA (20) . FCF ’ (J.3.40). FCK ' (3.40) 

* T I M END 


COMMON /REAL Z/ 

* C60LM (1,3) . Cfc (3.10 . CSCDU.4( 1 ,3) . CHC (3. 1C) 

* ' X+CCLM1 1 . I .9) . XMC (3.3.13). C8N(J) 


EQL 1 VALENCE 1 ETM 1 1 ) , THAOCI 1 ) ) . ( XMK ( 1.1 ) , A N GD 1 1 )) , 

* IXMN(1,3),YMCC(1.1 ,1)) . (XMM 1 ,6) . CNF( 1. 1 ) ) . 

« < XMN( 1 .8 ) . ET 1C < 1 . 1 ) ) , < XMN< 1 , 1 0) ,ETMC( 1 . 1 ) ) . 

« (FLS( l,l).FLO( l, 1) ) .(FLE(l.l.l). FLO ( 1.1,1)). 

* <FLH( 1 . 1 . 1 ) .FL J < 1 . 1 . I ) ) 

* 1FG1 ,LINIT( 1 )) , (CA( 1 .1 ) .RIN1T ( 1 )) . 

* <C6DUM!< 1 . 1 ) ,KZ IN IT( 1 ) ) . ( AwLRM l ) , I INI T ( 1 ) ) . 

* ( SCNOUM , I Z IS I T < I I ) , < TGRC < 7d ) . SCXC < I ) ) 


C 1MENS ILN TcMl (3) . TEM( 3 . 1 l ) ,X JD( 3 .1 1 ) 

CIMENSILN TEM2 ( 3) . TEM3 ( J ) ,F TEM( 3 ) . FLHC( 3 .3) 

CIVEFSICN EGFC(99>. EXCIC<594) 

FEAL*d FCljP(3. 3 .20) .FCLP1 ( 3 ,3) . KCuP (3 ,20 ) .'kCUP 1 ( 3) 
REAL*c TMF( 3.3). TKK( 2 ) 

INTEGER ST l ( 1C ) . 3 T2 ( 1 0 ) . ST3< 1 1 ) 

INTEGER ST4( 10 > 

INTEGER SFXMN . 1 

LOGICAL CTAIN 

EQLlVALENCE (OCMC ( 1 . 1 ) .TCM< 1 .1 ) ) . (EuFC(l).GFC(l ,1) )« 
* . (EXOICIl ).XOIC< 1.1 .1 )) 

CATA I H / 4HXM N ( / 

eolivalence (lqfdct ,lecu ) 


IF (LEGO 1FRINT 226 

zerc all elements in »mn matrix 


c leoaioo 
C 1 608200 
C 1 e06300 
c i eos4oo 
c i ece&co 
c i eoaeoo 
c i ecezoo 

C I 806800 

C 1 ecauoo 

C 1 809000 
C1EC91C0 
C ie09200 
C 1 609300 
c i e094oo 
Cl 6C9500 
C 1 609600 
c i e097oo 
C 1 e09800 
C 1 809900 
C 1 El 0000 
C 1 El 01 00 
c i ei 020C 
c i e i 0300 
C 1 El 0400 

c i ei oE-oo 

Cl 61 0600 
C 1 El C70C 
C 1 61 0800 

c i ei 0900 
c i ei i coo 
c i ei i i oo 

C1EI 1200 
C1E1 1 300 
Cl £1 1 400 
Cl 61 1 50 0 

ci ei 1600 

Cl 61 1 700 
C 1 8 l 1 8 C 0 
ciei i9co 
c i ei 2000 


X T E ft 6 = NFER NMV ♦ N MODS 
CO 16 N= 1 .NT ERM 
CO I £ M = N,NT£RM 
>HM»iM) = 0 
16 CON T INUE 

IF (L EGU )PW IN T 21 4 
C 

C CYCLE THROUGH ALL RC»S OF SYSTEM INERTIA MATRIX 

C COMPUTE INFER) X(NFEP) MATRIX OF SCALARS LEFT HANC ; S1DE OF 

C MATRIX EO LA TICK OF MOTION 

-CO 7 K=l.Nt3 1 

C : - • •• "CHECK FCR 3 CCNSTRAIN6C AXES 
' - ( IF (PCCN (K ) .NE. 3) GO TO 21 
IF(LECL IfRlNI 227 

' ' ■ ' (IF (LEGO )Fk>INTt :202 . K _ 

1F1LEGO IFHINT 227 
. GO TC 7 
C 

21 CONTINUE 

CALL ONPAC (ST3 ,NST3 . SCK ( K ) ) 


C 1 61 2 I CO 

I Ciei2200 

C ) e I 2 300 
ciei24co 
C 1 £1 2600 
C 1 81 2600 
C 1 6 1 2 700 
C 1812800 
SYSTEM C181290C 
C 1 61 JCCO 
Cl ei 3100 

■' Cl ei 3200 
Cl ei 3300 
C 161-3 400 
C 1 £1 350.0 
C 1 £ 1 3600 
Ciei 3700 
Cl ei 3800 
Cl 613900 
C 1 61 4000 


A-l 1 6 


C GET NCN-ZERO ELEMENTS IN RC* < UF XDIC 

Ip'lLEQU IFRINT 22 7 •• 

. IF (LEGE JFRINT 20 5, K , < ST2 C I ) . I =1 ,NST J ) 

IF (LECU IPHInT 228 
IF <N ST3 .EQ.O ) GO TC 41 
CO 4 C I I =1 , N ST 2 
I = ST31 II ) 

MBEG =SOF IK ) 

N8EG=SUF1I) I 

NTERM^SCFIK) ♦2-PCCMK ) 

NTERM=SCF( I ) ♦2-PCCM I ) 

IF ( MEEG . GT ,M TERM ) GO TO 43 

•CO 4 2 M= MBEG ,M TERM ' '' ! j 

IF (NEEG ,CT .NTERM ) GO TC 4E 1 

CO 44 N=NBEG .NTERM 
. IF (N ,GT .M > GO TO 44 

KI = K T 1 (Ndl ,K . I ) .* 

. ME = 2* < M- 1 ) 

NE = 2*IN-1) . 

KIE S 9»(KI-1) 

C CALL VUCYJVI OFC( 1 .Ml ,XDIC( 1 . l.KI > , CF C ( 1 . IM > . XMN(M.N) ) 

C . REPLACE MULTI-SUBSCRIPT CFEKATION WITH SINGLE SUBSCRIPT 

c COMPUTATION of vector cct cyao dot vector 

■, CO 1C J = l.3 

TEMl(J) = EXDICI K IE* J 1 *ECFC <NE*1 ) * 

* EXO IC< K IE*3* J I *ECJFC( NE + 2) ♦ 

* EXDICIK 1E+6+ J ) *EQFC( NE*J) 

1 C CONT INUE ' 

XMMM.N) - ECFCI ME+1 1 *TEM 1 ( 1 ) + 

* EGFCI ME+2 )* TEM 1 < 2) + ' ! 

* t QFC( M£*3 ) *TEM 1 < 2) - ! 

IF(LEOO 1FH INT 206 . M .N . M ,K I . N , M , K. I . N . X MN < M ,N J ' 

44 CONTINUE , 

"45 CONT InoE •’ • 

42 CONTINUE 

42 continue ;xh 

4 C CONTINUE 
41 CONTINUE 
7 CONTINUE 

c 

c 

c 

C INCLLOt FLEXIBILITY TERMS 

IFINFLXd ,EO. Cl GO TO l I 

c 

* CALL UNPAC ( ST 1 ,NST l , SFLX ) 

CALL UNPAC(ST4 .NST4.SFCC ) 

C 

C ' ZERO CUT GYROSCOPIC TOR CUE ARRAY ETM(M) • M =N F E R * 1 NFER+NMOCS 

N FI = NFEft ♦ 1 

. i NF2 = NFER * NM005 

' 0 : ■ CO l 7 M = NF 1 , NF 2 

IFILECUJ PRINT 252, M 
’• ■ 17. ETM< M > = 0 . 

■o i : ■> 

C CYCLE THRU ALL NESTS. FCR K = l PICK UP DIAGONAL AND ! MCST' OF) T 1 ’ ; 

C RICHT HAND SIDE OF EQUATION 

CO 3 K=l,NBUC 

CALL UNPAC(ST2 .NST2 , SK < K- 1 ) ) 

MN = 0 


C 1814 100 

ci ei 4200 

C 1 81 430C 
c i ei 4400 

ci ei 45oc 

C 1 814600 
ciei47oo 
C 1 81 4800 
Cl 814900 
Cl 81 S000 
CIE15100 

Ciei 5200 

C l 81 5300 
Cl 8 15400 
C 1 E 1 5500 
Cl 815600 
C 1 81 5700 
Cl ei 5800 
ci ei 5900 
Cl El 6000 

c i ei e i oc 

C 1816200 
C 1 6 16300 
c i ei 6400 
Cl 61 6500 
C 1816600 
Cl 81 67CC 
Cl ei 6800 
Cl ei 6900 
C 1 £ 1 7000 
C l 817100 
C 1E17200 
C 1 ei 7300 
Cl 81 74 0 C 
C 181 7500 
Cl ei 7600 
C 1 81 77C0 
C 1817800 
ciei7900 
cieieooo 
c i ei 8 i oo 
Cl 81 8200 
CieiB300 
C 1618400 
ciei8500 
Cl 81 8600 
Cl 8I870C 
C 1818800 
Ciei6900 
C I 8 I 9000 
C1819100 
C 1 £1 9200 
C 1 81 9300 
C 1819400 
Cl £ 1 9500 
Cl 81 9600 
Cl 81 9700 
C 1 819800 
C I 81 9900 
Cl e29000 


r 


A-l 11 



u u 


CO 3 NN=1.NST1 
N = ST 1 <NSU + I-NN ) 

C CHECK IS BODY N A FLEXieiLE BODY IN NEST K-l 

IF (C 1 AI N <N ,ST2 .NST2) ) CO TO 4 
AN = MNaSFXM(N) 

GO TC 3 

4 CONTINUE . . • • • 

IF ( .NOT .LEUu ) GO TO SCCC 
KM I . = K-l 
PRINT 234. N.KMl 
500C CONTINUE 
C 

C FOR K=1 GET; 1IDI AGONAL ELEMENTS uF XMN(M.N) 

C 2 ICENTR I P I T AL ACC. OF UNOEF0RMEC CM CF BODY N 

C 3)HAJCR PCKUCly OF £TM(MI 

C M=I\FER + 1 ... . .NFERFNMODS 

C 

IFCK.NE.l) GO TO 5 
TEM2(1) = 0. 

TEM212) s C. 

TEM2 (31 = 0. 

IF (LEOO ) PRINT 24 1 

C ■ CEN TRIP IT AL ACCELERATION UNDEFORMED POSITION OF aOCY N CF. 

M = N 

IF (M .EC *1 > GO TO 12 

CALL VECTRNICAOI I .M I ,XMC< 1 .1 .NI) , TEM3 ) 

IF(LEOU) PRINT 211, NI.M.NI 
CALL 1R 1PVPIF0MC1 1 ,Nl > .TEM3 ,TEM2) 

IFCLECU) PRINT 212. NI.NI.NI 
32 JM = JCCN(nI) 

CALL TR IFVPtFCMCl 1 .JNI ) ,CBC< 1 .Ni ) ,TEM3> 

■CALL VECADDl TEM2. TEM3.TEF2 ) 

IF(LEQU) PRINT 213, JNI. JN I .NI 
NI = JNI 

IFIM.NE.1J «C TO 32 
12 CALL SCLYIXMAS(N) .TEM2.TEM2) 

IFILEOUJ PRINT 222. N . ( T EM2 < J I . J = 1 . 3 > 
i CONTINUE 
C 

c 

c 

C CYCLE THRU ALL FLEXIBLE ECDY MODES ASSOCIATED »ITH BODY N IN 

C THE NEST K-l. FOR K=1 DC EXTRA COMPUTATIONS 

C 

S FXMN = SFXM(N) 

CC 3 1 I s 1 » SF XMN 
MN = MN ♦ 1 
F = NFER ♦ MN 

COFPLTE VECTOR elements LF F MATRIX AS NEEDED DON'T STORE IN 
COFFCN. STORE AS NEEDEC IN FTEM TO SAVE STORAGE 
KN = XT C (NB1 . K-l , N > 

CALL SCLV(XMASIN) .GAMC 1 .KN) .TEMJ) 

CALL VECROSl TEM3.FLACI l . MN ) .FTEMI 
CALL VECADD(FTEM,FLQC( I .FN) ,FTCM) 

IFf.NCT.LEOU) GO TO SO Cl . , .. . ’ 

KM l = K* 1 

' FRINT 23E. KM I ,N , FN, N , KM 1 . N , MN , MN , (FTEM ( J > , J= I , 3 » 

£00 1 CONTINUE 

IFIK.NE.DGC TO IS 

CALL TENTKNI FLHI 1 ,1 ,MN ) . XMC( 1 . 1 ,N» .FlHCI 


C 1 6201 00 
C 1 €2 02 CO 
C 1 62 0 30 0 
C 1 620400 
C 1620500 
Cl 620600 
Cl 620700 
Cl E20B0C 
C l E2090C 
C 1 62 1000 
C 1 62 1 1 CC 
cie 21200 
Cl 621 300 
c ie2 1400 
Cie2I500 
C 1 62 160 0 
C 1 62 I 700 

cie21800 
Cl 62 1900 
cie22000 

Cl 622 100 
C 1 622200 
Cl E223CC 
C 1 e22400 
Cl 622500 
C162260C 
C 1 82 2 7 0 0 
Cl 622600 
Cl 622900 
0 1623000 
C le23100 
C 1 e23200 
Cl e23300 
C 162J4C0 
Cl 623500 
C1E23600 
Cl £2 J7C0 
Cie236C0 
C 1 623900 
C 1 624000 
C 1624 100 
C 1 624200 
Cl 624300 

c i e244oe 

Cl e24500 
C 1 e246C0 
C 1 624700 
Cl e24600 
C 1 624900 
C 1 625000 
C 1 625 1 0 C 
Cl 62 52 00 
Cl 625300 
C 1 6254CC 
Cl 625500 • 
Cl 625600 
C 1 625700 
C 1 625800 
Cl 625900 
C 1 626000 


A-112 



u u.u u u u 


IF ( .Nor .LEUU ) GO TC SCC2 
PR IN T 22i 

FRINT 25C. (FLFC ( 1 . I ) , 1= 1 . 3) 

PRINT ^£2, MN ,N ,MN ,N . (FLHC ( 2 . I ) . 1= 1 . 3) 

PRINT 2SC. <FCFC< 2 . 1 ) . I = 1 ,3) 

5002 CONTINUE 
19 CGNTINuE 
C 

C COMP Lit ELEMENTS OF XMN ARRAY 

C 

IF (LEGO > PRI NT 22 £ 

IF (PCCN(K) .EG. 3) GC TO 4 6 
N1 = SOF(K) 

N2 = SOF(K) P 2 - PCCNIK) 

CH 6 L=N1.N2 

_ CALL VECCOTl OFC( 1 .L 1 .F TE.F , XFM M.L) ) 

IFCLECU) PRINT 23£. M , L . i- i'KM , N , MN . XMN ( M ,L ) 

^ 6 CC NT I Not 

A 6 CENT InUE 

c 

C THAT *2 IT FOR XMN IF K.NE.l 

IF ( K .N£ . 1 ) GO TO E 
XMM y ,rt) = XMASIN ) 

IFCLEJU) PRINT 237 . M . M , N . X N M M , M ) 

c cet terms associated with the translation eguation 

call SCLVIXMAS(N) ,FLAC ( 1 .MN1.TEM3) 

IF (PClin INB1 ) .EQ.3 ) G<J TC 8 
Nl = SUF (N31 I 

N2 = SOF(NBl) * 2 - PCCN(NBl) 

CO 12 L -Nl . N2 

• CALL VSCCOfl OFCI 1 .L ) ,TEM2 . XPM M.L) > 

IF(LEOU) PRINT 219. M.L.L.N.PN.X MN (M.L) 

12 CONTINUE 
E CONTINUE 

CK CONCENTRATE cn EMT ARRAY NOw 
PLT IN FTth.OFCl DC T ) TERMS 
CALL VECCOTl FTEM. CCMC( 1 .K ) ,A) 

ETP(P) = ETM(M) - A 

IF(LEOO) PRINT 2 3 E . M.M.KMl .N.MN.K.ETM(M) 

THAT «5 IT IF K ,NE . 1 
IF(K.NE.l) GO TO 2 

FUT IN SPR ING-DASHPCT EFFECTS MJOL N'M 

ETM(P) = t.TM(M) - XMAS (N )* ( 2 .« 2ETA1 MN) *FLUM( MN ) *THAC ( M) 
* ♦ Fi_L>M(MN)**2*THA(M) ) 

IF(LFJO) PRINT 239 . M .N .N.MN .MN.M.MN .M.ETMIM) 

CALL VCDYGVIFLMCI l.N) . FLFC . F CMC ( 1 .N ) . A) 

CALL VtCCUTl TEM2.FLACI 1 ,NN) ,B) 
tTMM) = c'TM(M) + A — H 

IF(LEQO) PRINT 24 C . M , N , N , M N . N . MN . £ TM ( M ) 

2 CONT INUC 
C 

c 

C ; CHECK TC SEE IF CCLPLING SIGNIFICANT , -• 

IF (NET 4 • EU . 0 ) GO TC 11 
KF = c 

MN = 0 

CC 3 5 K=l,NB0C 

C CHECK TC SEC IF BODY K FLEX ISLE 


C IE2E ICO 
C 1 e26200 
C l 626300 
C 1826400 
C IE26SC0 
C 1 626600 
Cl e267C0 
C 1 626600 
C 1 626900 
C1E2700C 
0 1 £271 00 
C 1 e27200 
C 1 627300 
C I E27400 
C 1 627500 
C 1 £27600 
C 1 627700 
C 1 627800 
01627900 
C 1 628000 
C 1 828 1 00 
C 1 828200 
C162830C 
C 1 628400 

c i e2esoo 

C 1 628600 
C 1 628700 
C 1 828800 
C 1 828900 
C 1 829000 
C 1 629100 
C 1 e29200 
C ie2930C 
C 1829400 
C 1 829500 
Cl e29600 
C 1 £297 CC 
C 1 629800 
Cl 629900 
C l 630000 
C 1 830 ICO 
C 1 630200 
C 1 630300 
C 1 e30400 
C 1 £30500 
Cl 63C60C 
C 1 £30700 
C 1 630800 
Cl £30900 
C 1 83 1000 
C 1 6 3 1 100 
C 1631200 
C 1 631 300 
Cl 83 1400 
C l 6 31 500 
C 1 631600 
Cl 631 700 
C 1 £31 8C0 
C 1 £31900 
C l 632000 
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; IFISFXMIKl.EU.O): GC TO if ■ 

C CYCLE THROUGH ALL GENERALIZED COURDINATE EQUATIONS FUR BODY K 

M M N = HN 
SF>MN = EFXMIK) 

■CO 3 2 N= l.SFXMN ... ' 

MN = M N ♦ 1 

CALL LNPACIST1 .NST1 .SCXCIMN) 1 

• IF INST1 .EQ .0 ) GO TO 33 

IF(LECU) PRINT 266 . N . K . AN . ( ST 1 ( I) . I = 1 , N5T 1 ) 

• -HI = N F £ fi + MN 

- CO 37 1=1.3 , . 

KCUP ( I . MM = 0 .0 ■ i 

CO 37 J= 1,3 
37 F C UP ( I . J .MN1 =0.0 
IF(LECU) PRINT 245 
i 1FIL6GU) PRINT 242, MN.MN 
■ < • CO 3 4 1 = 1. NS T 1 

• M ' = ST l INST1 + 1-11 
Mj = MMN ♦ M ♦ NFER 
KF — KF+ 1 

CALL ECLCI TrtAlMJ ) ,FCF< 1 . 1 ,KF> , TMF > 
y ' CALL OYACDIFCUPI l .1 .MM.TMF.FCJPt 1 .1 .MN1) 

IF< .NOT .LEDU) GO TC 5CC4 
PR INT 245 

PRINT 24t. IFCUPI l .L .MN) ,L=1 ,3) 

PRINT 247. MN . MN . M J , KF . < FCUP (2 ,L .MN >..L= 1 .3 ) 

PRINT 24£. ( FCUP ( J .L .MN ) ,L= 1 .3 ) 

5004 CALL SCLVI THADI M J ) ,FCK< 1 ,KF > , TMK ).. 

CALL YE C ADD ( KCUPI 1 .MN) .TMK . KCUP l 1 .MM1 
IF ( .NCT .LEQU ) GO TC SCO 5 

■ PRINT 24S 

PRINT. 24E. MN. MN . M J .KF . ( KCUP ( L .MN ) .L = l . 3 ) 

5005 CONTINUE 
■ 34 CUNT INUE 

C. TRANSFORM FCUP ANC KCUP TC COMPUTING FRAME 

CALL TENTRNI FCUP < 1 . I .MN ) .XMC I 1 . 1 .K ) .FCUP1 ) 

CALL VECTRNI KCUPI 1 .MN) .XMCI 1 . I .K) .KCUPI 1 
IF I .NUT .LEOU 1 GO TC 50C3 
PRINT 2 4 S 

PRINT 254, IFCUPI I 1 .L ) .L=l .3) 

PRINT 257. K .MN.K .IFCUPI I2.L) .L = l .3) ( . 

PRINT 254, IFCUPI I3.L ) .L=l .3) 

PR INT 245 , 

PR INT 255. K ,MN . I KCUPI IL ) .L= 1 .3) 

5002. CONTINUE 


C 

CALL VGOYUV I FOMCI I .K ) .FCUP l .FCMC I I . K ) , A) 

CALL VtCCOTIFCMCI 1 .K 1 , KCLP1 .d) 

ETMIMI) = ETMIMI) + A - 2.0*3 
IF.I .NOT .LEUU ) GO TC 50C7 
. PRINT 245 

'PRINT 2 4 9 • M 1 , MI, K.K.K, ETMIMI) 

500 7 CONT INUE 
3 2. CONT INUE 
J 5 CONTINUE 
I 1 CONT INUE 

C THAT *5 IT FOR MOCAL COUPLING 

C 

C 

c. computation for variable speed momentum wheels 


j + 1 1 -J ) » A 


C 1632100 
C I £32200 
C 1 €32300 
C 1 £32400 
C 1 €32500 
Cl e32600 
Cl €32700 
C 1 e32800 
C 1 632900 
C1E3300C 
C I e3310C 
.0 1 € 33200 
C 1 £33300 
C 1 £33400 
Cl £33500 
Cl £33600 
C 1 € 3 3 7 C C 
C 1 £33800 
C 1 £33900 
. C 1 £34000 
C 1 634 1 00 
-C 1 £34200 
Cl €34300 
C 1 €34400 
C 1 e3450C 
C 1 e34600 
C 183470C 
Cl 63480C 
Cl €34900 
C 1 £35000 
01635100 
C 1 €35200 
C 1 €35300 
Cl €35400 
C 1 £35500 
Cl £35£00 
Cl £35700. 
C 1 £35800 
C 1 835900 _ 
Cl £360 00 * 
,C 1 £36 100 
C 1 £36200 
C l £36300 
Cl €36400 
,C 1 e36500 
C 1 €36600 
Cl €36700 
C 1236800 
C 1 £36900 
Cl £37000 
C1637I00 
C 1 837200 
‘ C 1637300 
C 1637400 
_ Cl. £3 7500 
~ O! 1 £37600 
C 1 £37700 
Cl £37600 
C 1 e37900 
C 1 €38000 
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c 

c 


EXPAND C I ME NS I ON OF MATRIX EQUATIONS 
" ASSOCIATED KITH PRESENCE CF MOMENTUM 
CALL UNPACI ST 1 .NS T 1 . SM v ) 

IF (NET l .EO. 0 ) GO TC 5C57 

IF (LEQU ) PRINT 20 1 , (S r 1 < I ) , 1 = I . NST1 ) 

CO 2 MN;v.V = 1.NST1 
NVV=NST1-IMMMM-1 ) 

VM = S r 1 (MMM ) 

V = NFtH 4NST 1+ 1-MNV+NMCC S 
XMM V .M) = PLMIMM ) 

IFILEGU 1PRINT 203. V . V . V V . XVNI M .Ml 
CALL UNPACIST2 .NST2. SCKl »C < VV) ) 1 
ETV(V) = 0.0 C 

IFILEGU (PRINT 204 . V.ETMIV) 

IF (NST2 . EQ .0 ) GO TC 5356 
CO l i 1 = 1 .NST2 
I = £ T 2 I I I ) 

CALL VcCCOTIhMCI 1 ,VM) .DC VC I 1 . I ) . A ) 
ETVIV) = ETMIM) - A4PLMIVV) 

IF ILECU )FR INT 207. V.M.NN.VV.I 
KTERV = SCF< I) +2-PCCN I I 1 
K06G=SQF I I ) 

IF IKEEG .CT.K TERM ) GO TC 48 
CO 4? N=KBEG.KTERV 
N = K 

call vecco t i hvci i ,vm> t ofci i »x>«a> 

XMMV.N) = A4PLMIVM 

IF (L EGU )PK INT 209. V.N.VV.VV.k.XMMV.i 


AND COMPUTE SCALAR ELEMENTS Cie3E100 
KrlEELS C I 6 3B200 

C1838300 
C 1 E38400 
C 1 838500 
C 1 £38600 
C I £38 700 
■ Cl 638800 
Cl 638900 
• . C 1*639000 

‘ C i 839100 
C 1639200 
C 1 E39 300 
C 1839400 
C 1 639500 
Cl 83980 0 
■ C 1639700 
C I 63980C 
Cl 639900 
C 1 840000 
' Cl 84 0 1 00 
C164C200 
Cl 640300 
C 1840400 
C1640500 
C I 64 0600 
ci e407oc 

) ci£4oeoo 


47 CONTINUE 
' 4 6 CCNT INUE 

1 CONT INUE 

5058 CONT INUE ’ 

ETM(.V) = ETMIM) + CLMIMM) 

IF IL EUU )PR INT 210. M . V , V V . E T VI M) 

2 CONT INUE 
5067 CONTINUE 

C 1 ' 

c 

c 

c FILL IN UPPER TRIANGULAR PORTION 

NFVV = NFERFNMOOS+NM V 
CC 9 V = 1 . NF M V 
CO 9 N = V . NFM V 
9 XMM V ,,M ) = XMNIN.V) 

' IF I . NO T .LEQU ) GU TC 50C6 
FRINT 227 
I 1 = NFVV/4 

12 = NFMV - 4*11 

13 = II * 1 

CO 2 C 1=1.13 

J 

; IF ,( I .NE . 13) GO TO 22 
IF I I2.EG.0) GO TO 2 C 
. ... 14 = 12 - 1 

-. r- ,2*2~p I;5.' = 4*( I— 1 ) * 1 

CO 22 N = 1 , NF MV 
I5PI 4 = 15 * 14 

PRINT 2CC. I IH .M , N . XMN I V ,N ) . V= IS . I 5PI 4 ) 
23 CONT INUE 
FRINT 226 


C 1 640900 
C 1 64 1000 
C 1 84 1 ICC 
' - Cl 84 1200 
C l 64 1300 
01841400 
A ‘C 1 84 1 500 
J -C 1 84 1 bOO 

ci e4 i 7oo 

Cl 641800 
C 1 84 1 900 
C1642000 
C 1 e4 2 I 00 
C 1642200 
J C 1 642 300 
Cl 842400 
C 1 642500 
C 1 642600 
C 1 6427C0 
C 1 842800 
Cie4290C 
C 1 643000 
C 164 3 100 
01643200 
Cl 84 3 30 0 

' C l 84 3400 

I s. i v jj ■ ", ■' r 

‘ C1643500 

C 1 £ 4 3600 
: C l 643700 
Cl 6438CO 
Cie43900 
c i e44coo 
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c 

c 

c 

c 


2 C CONTINUE 
PRINT 227 

CC.vPLTE INB1JX1 COLUMN MATRIX JF VECTORS RESULTING FROM 
VECTORS MOVING RELATIVE TC FRAME CF COMPUTATION ' 

CONE d V EGUI VALENCE (DCMC.TEMJ 

PRINT 20E. (K.K,ITEWtI.K>,I = l.J).K = l..Nldl) 

PRINT 227 


5CCE 
20 0 C 


2 S 


MOLTIPLI INSlIXINSl) INERTIA MATRIX XDIC k I TH INE1IX1 MATRIX TEM 
NOTE THAT XCIC STOREC IN TRIANGULAR FORM PuT RESULT IN TEM 
CON T INUE 
CONT INUE 
CO 2A K = 1 • N B I 
CC 2<5 1 = 1. J 

XQC I I »< ) = 0 
IF (LEGO IPR INI 215. X 
IFIK.NE.NB1> GO TC 30 
CALL UNPAC (ST 1 ,NST l . SR > 

NS 1 2 = C 
GC TC 3 1 

3 C CALL UNP AC ( ST 1 ,NST 1 . S I ( K I > 

CALL UNPACIST2 »NS T2 , SKI K-l ) > 

ET2INST2) = N01 
21 CONTINUE 

START MATRIX MUL T IPL I C A T ICN ROW K TU RIGHT CF O I AGONAL 
IF ILECU 1PRINT 21 7 ,K, I ST2 ( I ) . 1 = 1 .NST2) 

IF (NST2 .EO .0 I GO TC 5CES 
CO 2 t 11 = 1, NST2 

C- ELEMENT K=I CELETE IT kA£ TAKEN CARE OF ABOVE 

- I = S T 2 I I I ) 

: CF. EC K FOP MULTIPL ICA Tt CN E Y ZERO 

: RECALL FROM RATE ThAT CCMCINB1I =TEMl(N0I> = 0 

IF < I .EO , Mi 1 ) GO TC 26 
IF ( .NUT .RBLUI I > ) GC TO 26 
K I = KT 1 (Nbl ,K .1 ) 

IF ILECU >PR IN T 220. K , K , K I • I . K , K , I , 1 
C NCTE THAT I .K TENSOR IS THE TRANSPOSE OF THE K.I TENSOR 

C' TFI3 HOWEVER OCES NCT INSURE THAT l.K IS SYMMETRIC. IN FACT 

S IN GENERAL IT WILL NCT BE SU HENCE OYTOV IS USED 

I CALL OYTCV IXCICI 1 . 1 , KI J.TEMI 1 , l > . TEMl ) 

I CALL VSCADDt XQDt l ,K) .TEN 1 .XCDI l ,K)J 
2t CONTINUE 
505S CONTINUE 

IF IL EOU >PR IN T 22 6 
IF INST l .EQ .0 1GC TC 506C 

IF IL EOU IPR INT 216. K , I ST II I M =1 .NSTI ) 

CO 2 S I I = l . NiSTl 

• '• , I = «T1 I II > = . , . , „ 

IF I .NOT .RBLG I I ) ) GC TO 2E 
: SCO Y I RIGIC OOOY 

K l = KTIINBl.K.I), . . 

“ IF (LEOU ) PR INT 1 K#K * K/I • I « K t < • I • I *.»/ ^ = » » } r i r 

CALL DYCCTV(XCIC( 1*1 |K I) *TEH( 1 » I ) • TEMl ) 

CALL N* E C AD D ( XQ D ( 1 .K) . TE M 1 . X CD ( l . K ) ) 

25 CONTINUE 
506 C CONT INUE 

IF (LECU >PR INT 228 

: FIMShEC MATRIX MULTIPLICATION RUM K OVER TO DIAGONAL 


C 1644 IOC 
Cl 84420C 
C 1 644300 
DIFFENT IAT C164440C 
C 1 644500 
C I 844600 
C 1 84 4 70 0 
r I 644800 
C 1 644900 
Cl 645000 
C 1 8451 OC 
C I 645200 
C 1 645300 
r l 645400 
C 1 645500 
C 1 645600 
C 1 645700 
Cl 645800 
C l 645900 
C l 646000 
C l e46l 00 
r i 6 4 6 2 0 C 
C 1 e462C0 
C l e4640C 
C I 646 SCO 
C l 646600 
C 1 646700 
Cl 64 6 600 
Cl 646900 
Cl 647000 
C 1647100 
C l 64 72 CO 
Ci 647300 
C l 647400 
Cl 647500 
C l 647600 
C 1 647700 
C 1 647800 
Cl 64 79C0 
C 1 648000 
Cl 648100 
Cl 648200 
C 1 648300 
C 1 e4840C 
C 1 846500 
Cl 6486C0 
C 1 e48700 
Cl 648000 
C 1 648900 
C l 6490 OC 
C 1649 100 
C 1 649200 
C 1 649JC0 
.C_l 64 .94 CO 
cl 649500 
C 1 649600 
C l 649700 
Cl 649800 
C 1 8499C0 

c i esooco 


.*■05 ; m.* 
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ACC UP GYKUSCCPIC. XQO ANC EXTERNAL T'JRUUE CN NEST K- 1 
IF(LEQU)FhINT 229. K . ( E TC ( I . K ) , I =1 . 3 ) 

IF (LEOU )PR INT 23 0 . K . ( XQC ( I . K ) ,1 = 1 . 3 > 

IF(LEC<J)FRINT 231. K ,(PHI( I ,K) ,1=1 ,3) 

CC 27 1=1. j 

27 ETCII.O = ETCII.K) - XCC1I.K) PHlll.iU 

IF (LEUU >FR IN T 232 . K , K . K ,K . (E TC ( I . K ) . I = l . 3 > 

2< ( COAT 1NUE 

IF < .NOT . LEJLI GO TO 3C0C 
PRINT 227 
CC 15 K = 1 . N B 1 

1 5 PRINT 229. K . ( ETC < I ,K ) . I =1 . 2 ) 

PRINT 227 
30 C C CCM1NUE 

: CCMFCTE (NFRE)Xl COLUMN MATRIX OF TURGUd COMPONENTS ALONG 

C FREE COORDINATE AXES 

CO 2 E . K=l,Ndl 
MB EG = SOF ( K ) 

MTER M =MEEG‘2— PCON (K ) 

IFIMcEG.GT.MTEHM) GO TC 5061 
CU 2t M =M8EG . M TERM 

CALL VECCGTl OFCl 1 .M) .ETC I I .K > ,r;TM(M J > 

IF (LEGO )FR INT 2 2 4 , M.M.K 

5061 continue 

2 £ CCNTINoE 

IFI.Nor. LEULI RETURN 
PRINT c cl 

M T EM M =NFER FNM V F nmcds 

CO 16 M = 1 ■ MTERM 
16 PRINT 223 . M.ETM(V) 

I 

RECUCT I C N OF VECTCR CYACIC EGUATIONS TO SCALAR EOUATIONS COMPLETE 
SUM CVdR N=1 .NFERfNMVMNMQDS 
XMN(M,N)*TFAC0(N> = E T M ( M ) 


c 

c 

C 

C 

c 

c 

c 


2CC format (4I2X.A4.I2,' ,12,') =',D15.a)) 

201 FORMAT (✓/,' LABELS OF VARIABLE SPEED MOMENTUM .REELS ' . 1 C I f . / > 

202 FORMAT (• BODY ',12.' TIED TO SYSTEM AT RIGID HINGE •) 

203 FORMAT ( / ,' XMM • . 12 , • . • ,12 , • ) = PLMC.I2.') = • . D 1 7 . 8 ) 

204 FORMAT ( 1 0 X . ' E T M ( • ,12,') = '.U17.6) 

205 FORMAT (■ NON-2ERC COLUMNS IN ROW ',12,' OF XD I C OVER TO CIAGCNAL 
‘ELEMENT ARE ',1115) 

206 FCRMAI (• XMM '.12, ','.12.') = UFC ( • . I 2 . • » . C XO I C( • . 12 . • ) . OF C ( • , I 2 

«•)) = OFC( • , 12 , • ) . (XCI C ( • . 12. ' . • , 12, • ) ,CFC< • , 12 . • > = *, 017,8) 


C1ES0100 
Cl 65020C 
C 1 E50300 
C I 650400 
C 1 £50500 
C 1 650600 
Cl E50700 
Cl E508CC 
Cl 1 50900 
C1E51000 
C 1 651 100 
01851200 
C 1 £51 300 
C 1 £51400 
C 1 £51 500 
C 1 £5 1 600 

■ C iesi 700 

C1E51800 
Cl £51900 
C 1 652000 
C 1 £52 100 
C ieS2200 
C1E52300 
C 1652400 
C 1 £ 52500 
C 1 652600 
Cl £52700 
Cl 652800 
C 1 85290C 
Cl P53C00 
C 1 £53100 
C 1 E5320C 
C 1653300 
C1E534C0 
)Cie53500 
C if 536CC 
C I £ 53 700 
Cl £53800 
01653900 
C 1854000 
C 1 654 1 OC 
C 1 £542 0 0 
Cl 854300 
C 1 £54400 
Cl £54500 
Cl 654 60 C 

, C 1 £54 700 
C 1 £54800 


20? FORMAT 

( eox , ■ 

ETM ' • 

12. •> = ETM( • 

. 12. 

' ) - PLM( • , 12, 

• ) » 

HMCl ' . 12, Cl £54900 

* ' ) • CCMiC< ' . 12 , 

• ) ■ > 





Cl £55000 

20£ FORMAT 

( * TEM( 

M2.' 

) = DOMC( • , 12 

. • ) 

= • ,3017.8) 


C 1 655 1 00 

209 FORMAT 

( ' XMN ( 

• . 12 . • 

. • . 12 , • ) = PLM ( • , 

12. • ) * HMC ( • . 

I 2, • 

) . OFC ('.Cl 65520C 

* 12 . • ) = 

’,017.8) 





C 1 855300 

2 l C FORMAT 

(EOX, ' 

fc TM< • . 

12.') = ETM( ' 

• 12. 

• ) * CLM ( < ,12, 

• ) = 

* , C 1 7 . £ ) C 1 655400 

*2 r iV 'format 

( 20 X , ■ 

C A CC ( • 

. 12 ,' ) = XMC( 

• l 12 

i • )*CA0( •'-.'•12, '• 

I " • > 

C 1 £55500 

212 FORMAT 

( 20X, • 

Tu M2 = 

FCMC ( '.12.') 

X ( F CMC ( '.12,') X 

CACC1 • . 12. • ) • C 1 €5560 C 

♦ ) 







C 1 655700 

212 FORMAT 

(EOX, • 

Tt£ *2 = 

TEM2 '♦ FJMC( 

' . 12 

. • ) X (FCMCl • . 

12, • 

) X C6C ( • . C 1655800 

* 12 . • ) • 

> 






C 1 £55900 

21 A FORMAT 

( ' XMN 

II 

o 

• 

o 

*./✓/) 




Cl 656000 


A -117 


215 FORMAT (■ xDQI*.I2.') - O’) C18561C0 

21£ FORMAT (• HO* '.12.* OF XCIC LEFT OF DIAGONAL USE ELEMENTS IN CCLLC185e200 
*MN£ '.10151 C I 856 300 

217 FORMAT »• HO* '.12.' CF >OIC RIGHT OF DIAGONAL OSE ELEMENTS IN CQLCie56400 
♦LMNS ’.1CI5) C 1 856500 

2 1 E FORMAT (• XOO(*.I2.') = >CC( , .I2,*1 ♦ XCIC('.I2.') . TEM(M2,* ) C1E56600 

* = •,* X CD ( • ,12,' ) * XC IC( • . 12 , • , • . 12, • ) . TEM ( 1 , 1 2 , • > •> Cie56700 

215 FORMAT (• XMM ■ , 12. • , • , 12. • 1 = OFC<*,I2.*) . ( XM AS ( * . I 2 . • > * F L A C ( • C 1 8S68 C C 

* . I 2 . • ) = • ,D1 2.5) Cl 856500 

2 2 C FORMAT (• xoor* . 12. • ) = ' XCD ( • . I 2 . • ) *■ XI) IL ( • , I 2 . • ) * * T . TEM ( • . I 2 . • C 1 85 700 0 


?) = >D O ( ' • 1 2 , ' ) ♦ XCI C< • . 12 . ' . • . 12. * > 


TEM (',12,') ' ) 


C1E571 00 
C 1 857200 
C 1 £57300 
Cl 857400 
Cl E575C0 
Cl 857E0C 
C 1 E577C0 
C 1 £57800 
Cl 857900 
C 1 858000 
. • ) = C 1 £58100 
C 1 858200 
Cl £5e300 
2. /) C185'e40C 

1 2 . • . C 1 £5e50C 
C 1 858600 
• . • . I C l e58700 
Cl 858800 
Cl £58900 

2 3 £ FORMAT (/,30X, • ETM(',I2,') = ETM<*,I2.*> - F T EM ( • . I 2 . • . • . I 2 . • . • . C 1 e59000 

* 12 . • ) .OCMCC ' . I 2 . • ) = ' . 3£X .0 12. -j) C 1 859 100 

239 FORMA I (SOX.' ETVC.I2, ') = ETM('.12.*> - XM AS ( • . I 2 . • ) * ( 2 . * Z E T A < • C 1 859 20 0 

* . I 2 , • ) »FLOM( • . 12 . • l-THAC ( • . 12 . • I «■ FlOM ( • . I 2 , • ) * « 2* THA ( • , I 2 . • ) ='.01 859300 

. 4C12.E) Cie59400 

24C FORMAT ( ’OX, ' fcTM* • , 12 . • ) ‘ = ETM(*,I2,') + F CMC ( • . I 2 . • ) . FLE C ( • . I 2 . C l e59 500 

* • 1 .FCMC C • . 12 . * I - TEM2.FLAC < * . 12. * I =' , 19X.C12.bl C 1 85960 0 

241 FORMAT (SOX. ' TE M2 = C ') k C1E59700 

242 FORMAT (SOX, • FCLPf'.ia.') = 0 KCUP ( ' . 12 , • 1 = O') C1 859600 


22 2 

FCPM AT 

< = 

OX . ■ . TE M2 = 

XMAS('.I2.') *TEM2 = * * 1 7 X , 3D 12*5) 

223 

FORMAT 

( * 

ETM( ME, 1 ) 

=; 

• t 3 C 1 7 • <3 ) 

224 

FORM AT 

( • 

ET M( • . 12 . • > 

= 

CF C ( • . 1 2 • • ) . t T C ( ' • I 2 * 1 ) • ) 

2 26 

F C P M A T 

< • 

1 SCcRULTI NE 

CFCOT ENTERED *.2(/)) 

22 7 

FOP MAT 

<3 

( / ) ) 



2 2 e; 

FO P M A T 

( • 

■ ) 



2*2 9 

F C.PM A T 

( * 

E TC( • . 12. • ) 

= 

• .30 17.8) 

2 30 

format 

1 • 

XOO( • . 12. ■ ) 


' . 3D 1 7.8) 

2 31 

FOP MAT 

i ■ 

PH I ( • . 12 . ■ ) 

= 

• . 3D l 7 .8 ) 

2 22 

FO PM A T 

< ■ 

ETC ( ■ . 12. • ) 

= 

ETC('.I2.») - XJD('.I2,'> ♦ PhK',12 

" * 

*•3017. 

8' 

.// ) 



22 2. 

FCPM AT 

( * 

E T M ( • , 1 2 . • ) 


• . C 1 7 .d ) 

2 34 

FCPM A T 

< /// .40X, • BODY 

•. 12 .' is a flexible body in nest '.i 

2 3 £ 

F Q.P MAT 

< / 

, • F TE M ( • . 1 2 

. • 

.'.12.*,*, 12,*) = XMAS( • . 12 . • )* CAM( • , 

* 

* . 1 2 . • ) 

X 

FL AC ( • . I 2 . • ) 

♦ 

FLOC( • , 12 . ' ) ='.3012.5) 

2 36 

FOP M AT 

( • 

XMM • , 12. • . 

' t 

12.') = OFC ( ' . 12, • ) .FTEMI • . 12 . • . • . 1 2 , 

* 

2 • * ) - • 

.ex.o 12 . 5 ) 



237 

FO PM A T 

( * 

X VN ( • • 12 . • • 

' • 

12.') = XM AS ( * . 1 2 . ' ) =• .23X.012.5) 


24 E FCRMAT < • ■ ) 

24e FORMAT (50X.3D12.S) 
247 FORMAT l 10X, ' FCUPC. 

* ) = • .20 1 2 . 5) 

24e : FORMAT (10X.* KLUFC, 

* ') = • , JO 12 .5 ) 


I 2 . ■ 1 = FOJPI • , 12 , • ) 

12.') = NCUP< ' . 12 . • ) 


Cl e59900 
C 1 860C0C 

THAI * • 12. • )+FCF ( • » I 2, ' Cl 86 0 IOC 

C 1 e60200 

THADI ’.12.' >*FCK( ', 12, Cl 860300 

C 1 £60400 


245 FORMAT ( JGX , ' ETM(',I2.') = ETM(',I2.'I *■ F CMU • . 1 2 . • ) . F CUP 1 . FC MC CC 1 660500 

* ' . I 2 « ' ) - 2. 0*FOMC( • , I 2 , • ) . KCUP1 =* .D12.S) C 1 £60600 

25C* FORMAT (71X.3D12.5) C16607C0 

251 FORMAT ( // .4 5X , ' MODAL CRCSS COUPLING SIGNIFICANT FCH BODY ’.12) C1E608C0 

252 FCRMAT 1/.30X, ' ETM(',I2,') = 0 •) CIE60900 

25 2 FORMAT (JOX.' F LHC ( • . 12 . • ) = XMC ( • . I 2 . • I *EL H< • , 1 2, • J «XMC (*.I2.'C186 1C00 

- *‘|*4T s*. 3012.5) Cie61100 

254 FORMAT (48X.3D12.S) C1861200 

255' FORMAT (10X.* KCUP1 = XMC I • . 1 2 , • ) »KCUP ( • . 12 . ' ) =* .3012.5) C1661300 

25 e FCRMAT (/.' EQLAT1CN OF MCTIC.N FCH MODE '.12.' CF 8UDY ',12,' (MOCC1E61400 

e c i’ec>i 500 


"'' rf Si , W6eR • 12 S • i’^Pas crcss c €qopl f’NG L FHOM MOCtS •VT6 'i , 4 l 

257 FORMAT (10X. 1 FCUP1 = X MC ( ' . I 2 , • ) *F CUP ( • . I 2 . * ) * XM C ( * . I 2 • * ) * * T 


* 20 12 .5 ) 


RETURN 


C l £6 1 600 
C 1 861700 
C ie618C0 
C 1 £61 900 
C 1 e62000 
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n r> no n r> 


EN C 


C'l £6 2 1 CO 


C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


suercutine uct 

. U SE C TC DEFINE DIFFERENTIAL EQUATIONS WHICH MUST 
TO DEFINE DIRECTION CCSINE MATRICES 


HE INTEGRATED 


SO 


ALL CONTIGUOUS FAIRS OF dOC I E S . ( K , JCON ( K > 1 HAVING 
SIGNIFICANT RELATIVE MOTION. DELETION OF KFRCM SC 
IMPLIES TR ANEFCHMAT ION MATRIX OF HOD Y K TC JCON(K) 


C IS 00 000 
C 1500100 
C 1 900200 
Cl 500300 
C150040C 
C 1 5005CO 
CISOOtOO 
Cl 500700 


IS CONSTANT IN TIME. OR DEFINED dY SMALL ANGLE AS SUMP T I O C 1 500 80 0 


□R .EULER ANGLE TECHNIQUES 


IMPLICIT REAL*6( A-F.O-Zi 
'LOG I C Al. FGl . FG2 . FG3. 

LRONGE , 


1 1 

FG4 , 


FIS. INEHF. KdLO. LEOU .' LIN I T( 1 1 


LOG I C Al 


L TRANV 
LCFDOT 


LTRNSI . LVDIV . LEOU I V , LTRAN 

LR ATE . LXDY . LET A , LTOr'oo 

LDCT , LANGLE . L SE TOP , .LS1MO 


INTEGER 


, C 1.5CC90C 
C 1.50 1000 
C l 501 100 
C 1501200 
C 1501300 
C 1501400 
Cl 501500 
C l 501 £00 
C 1 50 1 700 
C 1 50 1 800 
Cl 5C1.900 
C 1 502C0O 



AWCRK . 

CT1 


CT2 . 

C T 2 

• 

CT4 

CT 5 


FCCN 

• 

PCON 

. . Cl 502 100 


SCNCLM . 

SCN 


SCRDUM . 

SCR 

• 

SFKDUM , 

SFK 


SFW 

• 

SG 

. C 1902200 


S I , 

SIG 


S IXDUM, 

SIX 

• 

SKDUM . 

SK 


SL 

t 

SL K 

., 0502300 


sma 

SMCDUM 


SMC 

SMV 

• 

SDK , 

SP IDUM 


SPl 

« 

SQF 

. C15C2400 


SQL 

SR 


SSCN , 

SSIx 

• 

5 V A . 

SVB 


SVD 

• 

SV I 

. C l 502500 


SVM . 

SVP 


S VQ . 

SXM 

• 

SXT 

TCfiQ 


smal 

• 

SEU 

. C 1 5 02 60 0 


SC 

. SCG 


NFL XB . 

SFLX 

• 

SFXM . 

NMOOS 


.SFCC 

• 

see 

., Jt C *15 02 700 


I IN IT( 1 

) 


I 2 I N I T ( 

l ) 

# 

SD 






C 1 502800 


. RE AL « 8 

* ANGC (23) . CNF (2.10) , 

* FLO (2.20),.. . FLE (2.3.20) 

» TFACD (23) . YMCO (3.2.11)' 


COMMCN /LOEUUG/ LRLNGE . LTRNSI 

* LTRANV . LRATE 

* LOFOOT . LOCT 


ETIC 

flh 


(3,10) . ETMC (3.10) 

(3.3.20) . 


R INI T ( 1 ) 


LVDIV 

LXDY 

LANGLE 


. -RZIN IT ( 1 ) 


LEOU I V 
LET A 
L SE TUP 


LTRAN 

LTOROU 

LSIMO 


COMMCN /LOGIC/. FGl. FG2. FG3. FG4 , FG5. INERF. RdLJ(lO) 




COMMCN /INTO/ A WORK ( 2 0 C ) . . 


C 1 502900 
Cl 503000 
C15C3100 
C 1 503200 
. C 1 503300 
C I 5034C0 
C l 503500 
C 1503600 
C 1 503700 
C l 503800 
C 1 5C 3900 
C19040C0 
C 1 504100 
C 1504200 
C 1.5.04300 
C 1 504400 
C 1 504500 


* 

CT l 

. 

• 

CT2 


• 

CT 3 


, r 

CT 4 ^ 

J ; 

. C l 504600 

♦.SCT^S 


• 

^FCON , 


CC .N 

2- ) 

? ?. 1 U *j 

LCQN 

(22)’’ 

. C l 504 700 

* 

MC 

( 10 ) 

• 

Ne i 


* 

NrjQD 


• 

NCTC 


. C 1 504800 

♦ 

NFEK 


• 

NFKC 


# 

NFRC 


• 

NLOM 


. C 1 504900 


N*V 


• 



• 

N MC A 


• 

N SVP 


. C 1505000 

* 

NSVC 


• 

FCON 

(id 

• 

SD 


• 

SFK 

(33) 

, C 1505100 

* 

SC 


t 

S I 

( SS) 

# 

SIG 


• 

SL 


, C 1 505200 

4 

SLK 

(3 3) 

• 

SMA 

( 10) 

t 

SO K 

(11) 

* 

S OF 

(11) 

, C 1 505300 
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o n n r> 



SCL (11) 

• 

smv 


• 

SR 


• 

SSCN 


ss i x 

• 

SVA 


• 

SVd 


t 

SVO 


sv i 

• 

SVM 


» 

5 VP 

(22 ) 

« 

SVG (23) 


STM (2,10) 

• 

S XT 


• 

T UP G 

(97) 

t 

SMAL 


SEU 

• 

MG 


• 

SC 

(33) 

• 

SCG 


NFL Xd 

• 

SFLX 


• 

SFXM 

(10) 

t 

NMGDS 


SFCC 

• 

see 

(10) 








CCMMCN 

✓ INT62/ 





* 




* 

SCNCCM 


• 

SCN 

(0) - 

• 

SCROUM 

. 

SCR 

(9) 

n 

SFKCLM 


• 

SFK 

(5) 

* 

S IXDUM 

• 

SIX 

(9) 

* 

SKOCM 


• 

SK 

(5) 

• 

SP (DUM 

' . 

SPI 

(9) 

♦ 

S MC CUM 


« 

SVC 

( 0) 





. . ; 

CCMMCN 

/REAL/ 










C A 

(2.10) 


C AC 

(2.10) 

• 

CL M 

(10) 

COMC 

<3.11 > 


CCMC 

(2.11) 


ETC 

(2.11) 

• 

ETM 

( 33 ) 

F C MC 

(3.111 


G A* 

(2.66) 


h 


• 

HM 

(3.10) 

HMC 

< 3. 1 C ) 


HM.C* 

( 10 ) 


PHI 

(2.11) 

• 

PL M 

(10) 

GF 

(3.32) 


QFC 

(2.33 ) 


CL 

(2.22) 

t 

ULC 

(3.22 ) 

RCMC 

(3.11) 


T 






THA 

(33) 

THAD 

(33) 


ThAC* 

( 10 > 


Th A » 

( 101 

• 

XC IC 

(3.3.66) 

XI 

<3.3 ,,1C) 


X IC 

(2,3.10) 


XMAS 

(1C) 

• 

XMN 

( 33 . 33 ) 

XMT 

<3.3.10 


TUG 

(23) 


FLA 

(2.20) 

• 

FLB 

(3.20) 

FL C 

(3.20 ) 


FLD 

(3.3.20 ) 


FL J 

( 3.3.20 ) 


C AO 

(3.10) 

xio 

(3,3,10 


FLI PC 

(2.10) 


FLCRC 

(2.10 

• 

FLAC 

(3.20) 

FL GC 

(3,20 • 


FLC* 

(20 ) 


26 T A 

( 20 ) 

t 

FCF 

(3.3.40) 

FCK 

(3.40 ) 


T IMENO 











CCMMCN /REAL 2/ 
* C ED LM . (1.3) 

. CE 

(2.10 . CaCDUM(l,3> 

. CdC 

(3,10 

* XMCCUM< 1.1.9) 

. XMC 

(2.3.10). COM J ) 


- 


EOLIVALENCE < £TM< 1 ), THACC< 1 ) > 

* (XMN( 1 .3) . VMCC< 1 .1 .1 ) ) 

* ( XMN ( l .8) .ETIC< 1 .1 ) ) 

* (FLB( t .1 ) .FLQI I ■ 1) J 

* IFLH< 1 . 1 .1 > . FL J< 1 . I . I > > 

* (FGl iCINITU )) 

4 (CbDUMI 1 .1 ) .fZIMTll ) ) 

* < SCNDLM. 12 INIT < 1 ) ) 

C 

INTEGER EE T( l C > 

EOL l VALENCE (LOCT.LEQUJ 
C 
C ' 

C r ‘ ~ ' .n *■ ; • . - 

C . 

IF(.NCT. LEUL) GO TO 1 00 C 

OGbCOJiPR INT ICC 

30 = c 

Jl = 1 

J2= 2 
33 = 2 

100C CC FT I NOE 
N = C 


. (XMN (1.1). AN C O ( I ) > . 

. (XMN (1.6) .CNF (1.1), . 

. ( XMN ( 1 .10) ,ETMC( 1.1)) . 

. (FLE (1.1.1). FLD ( 1.1.1)). 

. 

. (CA( I . 1 ) .HINITC 1 ) ) . 

. ( AWORKl I > . UNIT ( 1 > ) . 



C 15C5400 
C 1 50550C 
C 1 <505600 
C 1 0057 00 
C 1005800 
C 1 005900 
C 1 006000 
C 1906100 
CIO 06200 
C l 5C6300 
C 1 006400 
C 1006500 
01006600 
C 1 906700 
Cl 006600 
01006900 
C 1 9O7O0O 
C 1907100 
C 1007200 
C 1007300 
C 1 0C7400 
Cl 007500 
C l 007600 
C 1 00 7700 
’C l 00 780 0 
Cl 007000 

ci ooecoo 
cioceioo 
cioce20o 

C 1006300 
C 1008400 
Cl 006500 
Cl 008600 
C 10C8700 
C l'OO 6 80 0 
C 1 9C89C0 
C100900C 
C 1009100 
C 1009200 
C 1 000300 
C 1909400 
C 1009500 
C I S00600 
C 1 0097C0 
C 1 009800 
C I 0C99C0 
C 1010000 
c loioioo 

C 1010200 
C I 91 0300 
C 191 0400 
C 1 51 0500 
C 1 91 0600 
Cl 01 0700 
ci 01 ceoc 
Cl 01 0900 
C l 9 1 1000 

c 101 1 100 
C l 51 120C 
C 1 51 1 3CC 


A-120 



r\ n n'h r> n n . n . n n 



■ IF(LECii) PRINT 104. .INERF 

CALL LNPACISET .NSET .SO ) . . 

.. IF INSET .EO. 0 ) GO TO 5062 
; IFILfcCU) PRINT 103. SO . ( SET! I) . 1 = 1 .NaeT ) 

If ( INERF.UR.3ETINSCT) . NE .1 I GO TO 2 
C • TP AN S OCDY 1 TO dOCY l CCMPLTING FRAME NOT NEEDED 
NEET = NEET - 1 

C ACCCLNT FOR INERTIAL TC EGGY 1 TRANSFORMATION 

C ANGLLAR VELOCITY INERTIAL TO UOOY 1 

- = - ANGULAR VELOCITY ECDY 1 TO INERTIAL 

= - FUMCIl.l). 1 = 1. 2. 3 , . ' ‘ ; 

N = N ♦ 1 * 

■ CO 4 1=1.2 

" C £ T NINLE SIGN IN EY RtVERSEING VECTOR CROSS PRODUCT 
_ - CALL VECROS ( XMCI 1 . I . 0 ) . FOMC < 1 . 1 I . YMCDI 1 . I . N) ) 

*■ 7 IF(LECO) PRINT IOC. I .N. I. JC.< YMCDI J.I ,N) ,J = 1 .3) 

A CONTINUE 

If ILE JO ) PRINT 1 OS 

2 IF (NEET.fcO.O) GO TO 50 £2 ' , 

• CO 3 KK = 1 . NSET 
N = N + l 

K; =; EETIKK) 

" CO 6 I = 1 .2 

CALL VECPUS ICCMC ( 1 . K ) .XMCI 1 . 1 ,K ) . YMCDI 1 . I .,N > ) 

IF(LECU) PRINT 107. I . N , K . 1 ,K . I YMCD ( J . I .N ) . J = 1 , 3 ) 

C CC NT INUE 

IFILEUU) PRINT 10E 
.. 3 CON T INUE 
£062 CONTINUE 

: .10C FORMAT (<1 SUBROUTINE CCT ENTERED •) 

102. FORMAT (• SO =*.26.* SET ELEMENTS *,I0I5> 

10. A FORMAT (• INERF = *.L10) 

1 C£ f'ormat ( • .< ) 

ICC FORMAT (• YMCDI • . 12 , • . • . 12 . • ) = XMC I • . I 2 . • i 12 . • > x FCMCl 

* . 3C 1 7 • d I 

107 FORMAT l* YMCDI • . 12 . • , • .12 .• ) = CCMCC*,^.*) X XMCI*. 12.*, 
.*.= • .3017.8) 

RETURN 

ENC 


I I SI 1 400 

ci si isoo 

Cl SI 1600 
C1SI 1700 
Cl 91 1 8C0 
Cl SI 1900 
C 1 91 2000 
C 1S1 2100 
Cl<12200 
Cl SI 2300 
C 1S1 2400 
C 1 SI 2500 
Cl SI 2600 
C 1 SI 2700 
C1S12800 
Cl SI 2900 
Cl 91 3000 
' Cl SI 3100 

C 1 ST 3200 
C 1 SI 3300 
C1S134C0 
C l S I 3500 
Cl SI 3600 
Cl SI 3700 
C 1 SI 3800 
C 1 SI 3900 
C1S14000 
C1S14100 
C l SI 4200 
C 1S1 4300 
C 1914400 
C1S145C0 
C 1 91 4600 
1 > = J * Cl 914700 
■ ; J:>< C1914800 

. 12 .• ) C 1 S 1 4900 
C191 5000 
Cl 91 51 00 
C 191 5200 


suercltinl angle 

LSED TC SET UP DIFFERENTIAL EUUATICNS *HICH DEFINE 
ANCULAR DISPLACEMENT AtGLT FREE CUORDINATES 
RECALL . 

SFRII) = FREE COORDINATE AXES AdUuT nHICH ANGLE TO 

ee ccmplteo 


c . 

IMPLICIT RtAL*8l A-h.O-Z . * ) 

LOGICAL FG1 . FG2. FG3 , FG4 • FG5. INERF, RBLO, LEOU . L l N IT I 1 ) 
LOGICAL LRLNGE . LTRNSl , LVDIV . LEQUIV , LTRAN , 

*. LTRANV . LR ATE . LXDY . LETA , LTORGU , 

*. L CFDOT . LDCT . LANGLE . LSETUP , LSIMG 


C2COOOOO 
C2CC0I 00 
C2C00200 
C2000300 
C2 C 00400 
C2CC0500 
C2CC0600 
C2C00700 
I Mil' 02000800 
C2C00900 
C2COIOOO 
C2C01 ICO 
• C2001200 
C 2001 300 
C2C0140C 
C2C01 500 


A -121 



no 


c 


c 

c 


c 

c 

c 

c 


c 

c 


INTEGER 



A*QRK 


CT1 


CT2 

C T 3 


CT4 * 

CTS 


FCCN 

• 

PCON 



SCNCUM 


SCN 


SCR DUM t 

SCR 

* 

SFKOUM , 

SFK 


SFR 

• 

SG 



S I 


SIG 


S IXDUN . 

S I X 

• 

SKDUM * 

SK 


SL 

* 

SL K 



SNA 


SMC DUM 


SNC • 

SM V 

• 

SOK • 

SP IOUM 


3PI 

• 

SOF 



SCL 


SR 


S SC N • 

S S I X 

• 

S V A • 

SVE 


SVD 

* 

SV I 



SVM 


SVP 


SVG • 

SXN 

* 

SXT i 

TGKG 


5MAL 

• 

SEU 



SC 


SCG 


NFLXB • 

SFl X 

t 

SFXM , 

NMODS 


SF CC 

• 

see 



I IN IT ( 1 

) 


I 2 1 N I T ( 

1 ) 

• 

SO 









RE AL < c 






* 

ANGC 

< 33) 

. CNF 

(2.10) . 

££T IC 

(3.10) . ETMC (3.10) 

* 

FLQ 

<3,20 ) 

. FLE 

( 2.3.20) , 

FLH 

( 3 i J *20 ) • 

* 

TPACD 

(33) 

, VWCD 

(2.2.11) . 

HIMT 

( 1 ) . . R21NIT (1 ) 


CCWMCN /CDEttUG/ L RUN GE 

. LTfiNSI 

. LVDIV 

. LEOJIV 

t L TR AN • 

* ltfanv 

. LMATE 

. LXDV 

. LETA 

• L TOR QU * 

* LCFDOr 

. LDCT 

. LANGLE 

. LSETJP 

• LSIMQ 



CO WWC N 

/LOG! C/ 

FG 1 . FG 

2, FG3. 

FG4 * FGL> 

I NL RF , 

WBLO (10) 



CO KMCN 

✓ INTG/ AAORK ( 20 C ) , 








C T 1 


• 

CT2 


• 

CT 3 


• 

C T 4 



C T 5 


» 

FCCJN 

(22 ) 

t 

JCCN 

(10) 

• 

L C ON 

(22) 


we 

(10) 

• 

Nfcl 


• 

NBCD 


. 

NCTC 



NFEF 


» 

NFKC 


• 

NF WC 


. 

NLUft 



NW V 


• 

NMO 


• 

NMOA 


t 

NS VP 



NSVC 


• 

PCON 

(11) 

• 

SO 


• 

SFR 

( 33 > . 


SG 


* 

S I 

( 25 ) 

• 

SIG 


• 

SL 



SLK 

( 23) 

• 

SNA 

< 10) 

• 

SOK 

(11) 

• 

SUP 

(11) 


SCL 

(11) 

• 

S MV 


• 

SR 


. 

SS CN 



SS IX 


« 

SVA 


• 

SVd 


* 

SVD 



SV I 


• 

SVM 


• 

SVP 

(22 ) 

• 

SVQ 

( 33 ) 


S XM 

(2.10) 

• 

SXT 


• 

roRu 

(97) 

* 

SM AL 



SEU 


• 

NTQ 


• 

SC 

133) 

• 

SCG 



NFLXd 


• 

sflx 


• 

SFXM 

( 10 ) 

* 

nmcds 



SFCC 


• 

see 

< Id 







. CCKMCN 

✓JNTuZ/ 










* 

SCNCLM 


• 

SCN 

( 9 ) 

• 

SCRDJM 


• 

SCR 

(9) , 

4 

• Sfkcgm 


• 

SFK 

( 9 ) 

* 

S I XDUM 


. 

S I x 

( 9 > . 

4 

SXDLM 


* 

SK 

( 9 ) 

* 

SPI CUM 


• 

SP I 

(9 ) 

4 

SMCCLM 


* 

SMC 

< 9 1 







- 

CCNMCN 

/ I'LAl / 









• + *1 


C A 

(3.10) 

t 

CAC 

(2,10 

# 

CL M 

( 10) 

. 

CCMC 

(3.11) . 


DCMC 

(2.11 ) 

• 

ETC 

(2.11) 

• 

E TM 

(33) 

. 

F CMC 

(3.11) . 

♦ 

l G AM 

( 2 , 60 ) 

• 

F 

“* *. w 1 • V 

• 

HNi: ' ' (3 • TO ) 

• 

,hMc;.; ' 



HMC N 

(10) 

• 

PH 

(3.1 1 ) 

• 

P L M 

(10) 

. 

CF 

(3.32) 


QFC 

< 2 , 3 j ) 

• 

CL 

<3.20 

• 

QLC 

(3.22 ) 

. 

WLMC 

(3.11) 


T 


• 




THA 

(33 ) 

• 

THAD 

<33 ) . 


Tf-ACw 

( 10) 

• 

ThA W 

(10) 

• 

X D I C 

(3 .3 .66 ) 

. 

XI 

< 3. 3 , I C) . 


X IC 

(2.3.10) 

• 

XMAS 

( 10) 

• 

XMN 

(33.33) 

* 

XMT 

(3,3,10 . 


C2C01600 
C 200 1 700 
C2 CO 1 800 
C2C0I 900 
C2CC2000 
C2C02100. 
C2C02200 
C 20 02 300 
C2C02400 
C2C02500 
C2C02600 
02C02700 
C2CO20OO 
C2C02900 
C2C03000 
C 2 CO 3 1 00 
C2C03200 
C2C03300 
C2C03400 
C2C03500 
C2C036CC 
C2C03700 
02003800 
C 2 003900 
C2C04000 
C200410C 
C2C042CO 
C2C04300 
C2C044CO 
C2 CO 4 50 0 
C2C04600 
C2C04 700 
C2C04800 
C 2C0490C 
C2C05000 
C2CCS100 
C2C05200 
C2C05300 
C2C05400 
C2CC5500 
C2C056CO 
C2CC57C0 
C2C05S0C 
C2C05900 
C2C06C00 
C 2 C 06 ICO 
C2C062C0 
C2C06300 , 
C2C0C40O 
C2C06500 
C2 C0660C 
C2C0670C 
C2C06800 
C2C0690C. 
.C2C07000 
C2C071C0 
C2C072C0 
C2C073CC 
C2C07400 
C 2 CO 750 0. 


A-122 


/ 



n n n ;n n. rvn.n 


♦ 

TUG 

( 23) 

• FLA 

(2.20 

. 

Ft_d 

( 3 .20 ) 

. 

FLC (3.20) . 

C2CC7&00 

* 

FLD 

C 3. 3. 2C ) 

• FL J 

( 3. 3 .23 ) 

. 

CAO 

(3.10) 

• 

XIU (3,3.1 C) . 

C2C07700 

* 

F L I F C 

< ^. 10) 

• FLCRC 

(3.10) 

. 

FLAG 

(3,20) 

• 

FLCC (3.20) 

C2C07800 

* 

c L C fr 

( 20 ) 

. ZET A 

( 20 ) 

• 

FCF 

( 3.3 .40 ) . 

FCK (3.40) ; 

C2CC7900 

* 

T IME-ND 









C2C08000 







* 




C 2 C 08 100 











C 2 C C 82 00 


CCMCN 

/Ft AL Z/ 




* 




C 2 C 0 8300 

* 

CEDIM 

(1.3) 

. CE 

(2.10) 

f 

ldCDJM (1.3) 

. 

CdC ( 3 , 1 C ) . 

C2C084C0 

* 

XK CUM ( 1 . 1 . S) > 

. XMC 

( 3 . 3 . 10 ) 

* 

CBN( 3 > 



C2C0850C 











C2C08600 

- 










C2C0870C 


eulivalence (e tmi i ) , thadci i ) ) 



. ( XMN ( 1 

• 1 ) 

. A N CD ( 1 ) ) 

C2C088CO 



( XMN ( 1.3). 

YMCC ( l . 1 . 

1 ) ) 

» ( XMN ( 1 

• o ) 

. CNF( 1 . I ) I , 

C2C08900 



( XMN I 1 ,d ) . 

ET IC( 1 .1 ) ) 


• ( XMN ( 1 

. 1 0) . ETMCI 1 , 1 ) > . 

C2C09000 



(FLU ( 1 . 1 > . 

FLQ( 1.1)) 



. (FL£ ( i 

• 1 • 

1 ) • FLD ( 1.1.1) ) . 

C2C09100 



( FLH ( 1.1.1 

) . FL J ( 1 . 1 

. 

i ) ) - 

» 



C 2 00 920 0 



(EG 

1.L1NITU ) ) 



. ( CA( 1 . 

l ) • 

R IN IT ( 1 ) ) 

C2 CC9300 



(caouM( i • i 

) .RZ1MTI l ) > 

• ( A*URK( 1 ) 

. I I N IT ( l ) > , 

C2C0940C 


( SCNDLN . IZ1N IT < 1 ) ) 

EQUIVALENCE (LANGLE.L6CL > 
INTEGER SI <33 > ,S2( 33 > 


IF(LEQU) PRINT IOC 


FRCCEEC SEQUENTIALLY NC» DEFINING UNLY THOSE EQUATIONS CALLED FCR 
TAKING SPECIAL NOTE OF 2-AXIS GIMdALG riET » E EN RIGID BODIES 
IF(LEJU) PRINT 101. NFRC .<SFfi( I > , 1 = 1 ..-IFRC) 

K = 1 

V = 1 

DC 5 N=l,Ndl 
IF(N.EG.l) GU TO 9 
N = ► + J- FCUN (N- 1 ) 

continue 

KT = HIGHEST MAGNITUDE INDICE AT HINGE POINT N-l 
,VT = y*2-PCUN(N) 


C2C09500 
C 2C0960 0 
C2 C09700 
C2C0900C 
C2C099C0 
C2C1 0000 
C 2 0 1 0 1 0 0 
C2CI0200 
C2C1 0300 
C2C10400 
C2C10500 
C2C1 0600 
C2C1 0700 
C2C10800 
C201 0900 
C2C1 1 000 
, C2C1 1 1 CO 
C 201 1 200 
C 2 0 1 1 300 
C2011400 
C2C1 1 50 0 
0201 1600 


7 IF < SFS ( K ) . GT .MT .OF .K .GT . NFRC ) GU TO 5 
, IF ( N ,EC .Nd 1 } GC TC 4 
IF <R ELO(N) .AND .PCCM N > .EC. 0 ) GO TO 6 
, IF (RELJ(N) .AND .PCCMNI .EC. 1 ) GU TO l 

/ ' ' 4 CONTINUE 

IF (SFR(K).EQ.O) GC TO 5 
ANCD(K) = THADISFMK) ) 

IF (L ECU ) KK=SFFi( K ) 

IF(LEQU) PRINT 102. K.KK.ANCOIK) 

. , . . K = K + 1 

CC TC 7 
C 

c ■ special case check fcr skexed twu axis ginbal 

O 00 \ . \ , : u 1 . I. > j .V, -< v :ni,t 1 M : I . 

1 call VECCUTI OFCI l ,N> ,OFC ( 1 . RM ) .C) 

IF ( C .EQ . C.DO )' GO TC 4 

call VECCOT( OFCI l .N ) .RCMC < 1 .N) . Al ) 

CALL VECDO T( QF C ( 1 ,MF l ) . F CMC ( 1 . N ) . A3 ) 

ANGC(K) - ( A 1 - C»A3)/(1.C0 - C*«2) 

AN GC (K.l ) = (A3 - C*A1)/(1.CC - C**2) 


H . ( ml <• > 


C 201 1 700 

C2 C I 1 800 

C2C1 1 900 

C2.C1 2000 

, C 2 C 1 2 1 0 0 

C2C1 2200 

C 201 2 300 

C2C12400 

C2C1 2500 

C2C12600 

' C 20 2 700 

C2C128C0 

C2C12900 
* 6, r ‘ <? 

C2C1 3000 

C2CI 3 ICO 
C 2CI 3200 
C 2 C 1 3300 
C2C1 34CC 
C 2C i 3500 


A-123 



u u 


IF ( .NUT .LEUU 1 GO 
N 1 = M<- 1 

K 1 = K * 1 

FR INT 10: 

I CE 
1 Ce 
I C 7 
1 C5 


TC IOC1 


10 0 1 


FR INT 
FR IN T 
FR INT 
PRINT 
CONT I NUfc 
K r X \2 
GO TC 5 


CCNT 1NUE 

special cask 


M.N.AI 
Ml ,N,A3 
M.Ml.C 
K iANGOIK ) 

K 1 . ANGCOC1 ) 


THREE axis CINEAL 


NOTE LOuIC ASSUMES TEAT 
SFk(K) ,SEH(K.+ 1 > , SFR(K«2> 
" ARE THE THREE GIMdAl AXES 

CALL VcCCDT( C'FC< 1 .Ml .RCMCIl .Nl.Al 1 
CALL VECLGTl OFC{ 1 .M+l I .FCMC ( 1 .N) . A2 1 
CALL VEGDGTl OFC< 1 ,M*2) .FCMC ( 1 .14) .A3 1 
CALL VcCC JT( UFC ( 1 . M ) .C1FC ( l .Cl 

ANGO(K) = ( A 1 - C*A3)/(1 - C««21 

AN GO ( I ) = A2 

ANGO (Kfl 1 = (A3 - C*A1 l/( 1 - U«»21 

IF(. NUT. LEUU) GO TC 100C 
Ml = W+ 1 
M2 = M «■ 2 
K1 = <41 
X 2 = K + 2 
FR INT 1 C3. 

FR INT l CA, 

FR INT ICE. 

PRINT 106. 

PRINT IC7. 

FR INT ICE. 

PRINT ICS. 

101C continue 

K = X 4 3 
E CONTINUE 


M.N.AI 
Ml . N . A 2 
M2 , N. A3 
M , M2 . C 
K . ANGD ( K 1 
K1 . ANGCU.+ l 1 
X.2. ANGDIK+2 1 


C2C1 3600 
C2C1 3700 
C 20 1 3800 
C201 3000 
C2C1 4000 
C201410C 
C 201 4200 
C2C1 4300 
C2C1 4400 
C 20 1 4500 
C2C1 4600 
C 2 Cl 4 700 
0201 4QC0 
C2 Cl 4900 
C2C1500C 
C2C1 5100 
C2CI 5200 
C 2 Cl 53CC 
C 20 1 5400 
C2C l 5 EC 0 
C2C1 SbCO 
C2C1 5 7C0 
C2C! 58CC 
C 2 C 1 5900 
C2C1 6000 
C2C1 6 I OC 
C 2C 1 6200 
C2C1 6300 
C2C1 6400 
C2C1 65C0 
C 2 0 1 6 6C 0 
C2C1 6700 
C2C1 6800 
C 2 Cl 6900 
C2C1 7000 
C2 Cl 7100 
C 2 C 1 7200 
C 20 1 7300 
C2C1 7400 


ICC 

FCPV/!T 

( • 1 

SLfcJfcOLTI Nh 

ANGLE ENTERED' • 1 

5 

C 2 C 1 75CC 

1 C 1 

FORMAT 

(UC 

> . • ELEMENTS 

IN ARRAY SFR, THEr ARE 

• • 3 J i J ) 

C2C1 7 6C 0 

1 C 2 

FUfiMAT 

( • 

ANGD( • • 12 . 1 

) = ThAU( • . 12. * 1 = • ,C17 

* o ) 

C2C1 7700 

1 C 2 

FUPMM 

( ■ 

A 1 = QFC( * • 

12 . ■ 1 . RUMC ( « . I 2 . * ( = 

• .017.8) 

C 2 01 7800 

1 C A 

FORMAT 

( • 

A 2 = QFC( • • 

12 . • 1 . RUMC ( * . I 2 , • 1 = 

'.017.8) 

C2 Cl 7900 

ice 

FORMAT 

( • 

A J = OF C( * . 

12 . ■ 1 . ROMC ( * . I 2 , • 1 = 

* .C 17.8 ) 

c 2 o i e o c o 

i ce 

FUFMAT 

( • 

C = bFc( • . 

12 . * 1 . (1FC( • . 12, < 1 = 


C2C1 8) 00 

107 

FORMAT 

( • 

ANGO ( • • 12 . • 

1 = ( A 1 -C*A 31 /{'! -C«»2 1 = 

' .017.8) 

C 2 C l 8200 

toe 

FORMAT 

( • 

mNGO ( • * 12 . # 

1 = A2 

•,017.8) 

C2CI 8300 

1 09 

FORMAT 

( * 

ANGO ( • . 12 * • 

1 = ( A3-C4A1 1 /( 1 -C**2 1 = 

» » Cl 7 .8 ) 

C 2 C 1 6 4 C- 0 

1 i c 

FORM A T 

(110 

» * ELEMENTS 

IN ARRAY SMA, THEY ARE 

*.1013) 

C 2 C 1 8500 


RE TURN 



„ 


C2C18600 


ENC 




' 3 i * v * 

* ' r C 2C 1 8 700 





% s 1 i 

_ j ^ 



C 

suercutinl SETUP ( Y , YD . NE C, SUHT ) 
c if ecr r = .true. sgft cut integrated uuantities 


C2 100000 
C2 1 00 1 00 
C2 10C200 


A-l 24 


ft ft r> n nn ft n ft ft ft ft n n ft ft 



- 

.FALSE, s 

El UF ONE DIMENSIONAL ARRAY OF EOLATIONS 

TO C 2 ICC 300 




EE INTEGRATED 





C 2 1C0400 











C 2 100500 
C2 100600 

IMPLICIT KcAL*e( A-H.O-Z 

. 1 ) 






C 2 ICC 700 











C 2 100800 
C2 1 0090C 

LOG I C Ai_ 

FGl • 

F62 • FG3. 

FG4. F j5» INERF. HbLO. 

LEGU . LIN IT( 1 ) 


C2 10 1 CCO 

LOGICAL 



LRLNGE 

. LTPNSI 

. LVUIV . LlOU I V 

, ltran , 


C 2 101100 

* 



L Tf-ANV 

. LRATE 

. LXDY , LETA 

. ltcrou . 


C £ 101200 

* 



LGFDOt 

. LOCT 

• L ANGLE • L St T UP • LSIMQ 


C 2 10 1 30C 











C2 101400 
C2 1 0 1 500 

INTEGER 










C2 101600 

* AHOPK 

• CT 1 

-• 

CT2 

. C T 3 

. CT4 . CT 5 

« 

FCCN 

. PCCN 

. 

C2 10 1 70C 

* SCNCJM 

. SCN 

. 

SCR DUN 

, SCP 

. SFKCUM. SFK 

. 

SFR 

. SG ^ 

. 

C2 101800 

* S I 

• 3 IG 

• 

S I XDUN 

, SIX 

. SKDUM . SN 

. 

SL 

• SLK 

. 

C2 10 1900 

* SNA 

• SMC DUN. 

SNC 

• SMV 

. SUK . SPIDUM, 

SPI 

. SQF 

. 

C 2 10 2 0 CO 

♦ SGL 

i SR 

* 

SSCN 

. SSIX 

• 5 V A • SVE 

. 

SVC 

. SV I 

. 

C2 1021 00 

* S VM 

. SVP 

• 

SVQ 

. S X N 

. SXT . TORO . 

. 

SMAL 

. SEU 

. 

C I 1 02200 

« SC 

. S CG 

■ • 

NFL XB 

. SFLX 

• SFXM . NMODS 

. 

SFCC 

. see 

. 

C 2 10 2 3 0 0 

* I IN I T ( 

1 > 

• 

12 I N I T( 1 ) 

. SD 





C 2 102400 











C 2 102500 
C2 1 02600 

fiE al * a 










C 2 102700 

* ANGC 

(33) 

. 

CNF 

(3.10 

. ETIC (3.10) 

. 

etmc 

(3.10) 

. 

C 2 102800 

* FLO 

(3.23) 

• 

FLE 

(3.3.20) 

. FLH (3.3.20) 

. 




C 2 102900 

* TFACD 

( 33) 

• 

V MC 0 

(3.2.11) 

. R INI T ( I ) 

. 

RZINIT( 1 ) 


C2 103000 











C 2 103100 
C 2 103200 

CGNMCN 

/LDcbUC/ 

LfiLNGE 

• L TP NS I 

. LVDIV . LEOUIV 

. LTRAN . 


C 2 103300 

* 



L TSANV 

. LRATE 

. LXOY . LETA 


, L TOR QU . 


C 2 103400 

* 



LCFDOT 

. LOCT 

. LANGLc . LSETUP 

. LSIMO 


C 2 103500 










/\ | 

C2 1036C0 











C2 10370C 

COMMC N 

/LCGI C/ 

FGl. FG2 

• FG3. FG4* FG5* INERF. 

RBLG ( 1 0 ) 



C 2 103H00 











C2 103900 
C2 104000 

CONMCN 

/ IN TG / 

A 1*0 RK ( 184) . S T 1 • N . 

M » M N . NS T I . J . 1 . 





C2 10410C 

* CT 1 



CT2 


. CT3 


C T 4 



C 2 104200 

* CT5 



FCCN 

( 33 ) 

, 3CCN (10) 


LCCN 

(22 ) 


C2 104300 

♦ MC 

< 10 ) 


NEl 


» Ni30D 


NC T C 



C2 104400 

4 NFER 



NFKC 


. NFRC 


NL uR 



C2 104500 

4 N N V 



KMO 


• N MU A 


N SVP 



C 2 10 4600 

♦ NSVC 



FCCN 

(11) 

. SC 


SFR 

(33 ) 


C2 104700 

* SG 



S I 

( EE) 

. S IG 


SL 



C 2 104800 

♦ SLK 

l 33) 


SNA 

( 10) 

. SGK (11) 


SGF 

(11) 


C 2 1 04900 

* SCL 

( 11 ) 


SMV 


. SR 


SSCN 



C 2 1 C5000 

* S S I > 



SVA 


. sva 


SVD 



C 2 105100 

* SV I 



SVM 


. SVP (22) 


SVG 

( 33 ) 


C 2 10520C 

* S *M 

(3.10) 


S >T 


. TURG (97) 


SMAL 

. 


C c 1 0 530 C 

4 SEU 



NTQ 


, SC (33) 


SCG 



C2 1 CS400 

* NFL>d 



SFLX 


. SFXM (10) 


NMODS 



C2 1 05500 

* SFCC 



see 

( 10 ) 






C 2 1 056C0 
C 2 105700 
C2 105800 

CC N M C N 

/ IN TG Z/ 









C2 I C59C0 

* SCNCLM 


• 

SCN 

(5) 

• SCHDUM 

* 

SCR 

( 9 ) 

. 

£2 106000 

♦ SFKCUM 


• 

SFK 

( <5 ) 

. SIXDUM 

. 

SIX 

(9) 

. 

C2 106 1 CO 

4 SKDLM 


* 

SK 

(,S ) 

. SPIDUM 

. 

SP I 

(9 ) 

. 

C 2 106200 


A-125 



♦ 

SNC CUM 

t 

SMC 

(9) 







C2 106300 













C2 1 06400 













C210650C 


CCVMCN 

/REAL / 










C 2 106600 

* 

C A 

(3.10) 


C AC 

(3.10) 


CLM 

(10) . 

CCNC 

(3.11) 


C 2 106700 

♦ 

DCMC 

(3.11) 


ETC 

(3.11) 


ETM 

( 33) 

FLNC 

(3.11) 


C2 1 06000 

* 

GAM 

(3.66) 


F 



MM 

(3.10) . 

HMC 

<3.10 


02 1 06900 

* 

H VC V 

( 10 ) 


FF I 

(3.11) 


PLM 

(10) , 

UF 

<3.321 


C2 107000 

* 

OF C 

(3,33) 


CL 

( 2 .22) 


OLC 

(3.22) . 

RCMC - 

(3.11) 


C 2 107100 

* 

T 






TnA 

( 33 ) 

ThAD 

( 33 ) 


C 2 107200 

* 

TFACW 

( 10 > 


THA 

(10) 


AO 1C 

(3,3, 66 ). , 

XI 

(3.3.10 


C 2 107300 

* 

x ic 

(3.3. 10 1 


XMAS 

(10) 


XMN 

( 33.33) . 

XMT 

<3.3.10 


C2 107400 

* 

TLG 

(33) 


FLA 

(3.20 


Fi_e 

(3,20) . 

FLC 

<3.20 


C2 1 07500 

♦ 

FID 

( 3. 3, 20 ) 


FLJ 

(3.3 .20) 


CAO 

(3.10 . 

X 10 

(3.3.10 


C2 107600 

* 

FLI FC 

(3,10) 


FLCWC 

<3.10 


FLAC 

( 3.20 > 

FLOC 

(3.20) .. 


C2 1C7700 

* 

-flc n 

( 20 ) 


2ETA 

( 20 ) 


FCF 

( 3.3 .40 ) . 

FCK . 

(3.40) 


C2 107800 


’ ♦ TIMENIO 


CCVMCN /RE AL Z/ 
* CEOLM (1,3) 

« X N C C L M ( l« 1 » 9 1 


ce 

XFC 


(3. 

< 3 , 


1C ) 
3.10) 


CdCOUMI 1 I 
CdN ( J ) 


3 ) 


(3,10) 


egl t valence 


<£TM< 1 ) , THAOC ( 1 ) ) 

( XMN ( I »3),YPCC( 1 ,1 ,1 ) ) 

( XMN ( 1 ,8 ) , ET ICC 1 , l ) ) 

< FL6( l . 1 ) . FLC< 1,1)) 

(FLH (1,1,1). FLJ (1.1.1)) 
(F,l .UNIT! 1 )) 

(CEDUMI 1,1 ) . R2 IM r ( l ) ) 

( SCNDLN . 13 IN IT ( 1)) 


. ( XMN ( 1.1) i ANGD( 1 ) ) . 

. ( XMN ( I ,6) ,CNF( 1,11) , 

, ( XMN (1.10) , ETMC ( 1.1)) 

. (FLE (1,1.1) ,FLD< 1,1.1)), 
, 

. ( CAI 1 . 1 ) . R IN IT ( 1 > ) . , 

. ( **L,HK( 1 ) , I INIT ( 1 ) ) , 


, .IN TE GER STIC 10) 

LOGICAL SORT 

CIFENSICN rl NEG) , YC( NF.C) 
"2CLIWLENCE (LSETlF .LECU ) 


1F1LEGU1 PRINT IOC 


ANGULAR CK LINEAR RATE RELATIVE TU FRH, 
CC 1 N=1,NFER 
IF (SCR T) G J TO 10 
■ VO (N ) = THAL0( N) 

IF (L ECU ) PRINT 102, N . N . VC < N ) 

GO TC l 

1C TF AC (N ) = YIN) 

IF(LEGU) PRINT 202 ,N .N . TFAC (N ) 

1 COM 1NUC 

..NEC = NF EK ' 's 


..GENE RALI ZLli ELASTIC COLRCINATE RATE EGUATIUNS 
IF ( N NODS .EG. 0 ) GO TO 5C63 ' . ■ - 

CO 7 N N = 1 , NM COS 
N = NEC 4NN 
IF ( SCR I 1 Gd TO 9 
VD <N ) = TMADC(N) 

IFILEGU! PRINT 102. N.N.VO(N) 


COORDINATE AXES 


UN - 


C 2 107900 

cp i cacoc 
C2 ical oo 

C2 1CE200 
■ C? 108300 
C2 130400 
C2 108500 
C2 100600 
C 2 108700 

C2 icaeoo 

C 2 108900 
C2 109000 
C210910C 
C 2 1 09200 
C 2 1093C0 
C 2 1 09 AO 0 
C c 1C9EOO 
C2 1 09600 
C 2 109700 
C 2 109 80 C 
C 2 109900 
C 2 1 1 0000 
C2 1 1 0 100 
C 2 1 10200 
C 2 1 1 0300 
C2 1 1 OAOO 
C 2 I 1 0500 
C 2 1 1 060C 
C2 1 1 0 700 
C 2 1 1 0000 
C 2 110900 
C2 1 1 1 COO 
C2 1 1 1 100 
C 2 1 1 1 200 
, C 2 1 1 1 300 
‘ C2 1 I 1 400 
C2 1 1 1 500 
„ C2 1 1 1 6C 0 
. C2 11 1 700 

C 2 i i i eoo 
C2 1 1 1 900 
C2 II 2 0 CO 
C2 112100 
C 2 112200 


A-126 



GC TC 7 

S THAOIN) = YIN) 

IFILEQU) PRIM 202. N.N.1HACIN) 

7 CONTINUE 
£06 3 CGNT INUE 

NEC = NEC A NMOOS , 

C- 

c , 

C RELATIVE ANGULAR NCMEN1LN V.FEEL 

CALL UNFACISTl iNSTl .SMV) 

IF (N £ T I • EG • 0 ) GO TC 5064 
CO 2 KMK = l ,NST1 
M* = N £ T 1-IMMM-l ) 

» = £Tl I KM) 

' N = NEQANST1 Al-MM 

IF ( SC R T ) GO TC 1 1 •- ’ : 

TO ( N 1 = THACO(N) 

IF (LEGO ) PRINT 104. N.N.YCIN) 

CO TC 2 

11 TKACUMI = YINI 

FMCMIK) = PLMI M) * THAO* IM ) < l ' ■ 

'IF(LEQU) PRINT 205. V . N . THA C <t ( M I 
IFILECU) PRINT 2 0 A . R.R.R.HRCMIM) 

2 CONTINUE 
£0 6 A CONTINUE 

NEC = NEC A NST1 

C • . ■ - • 

C Cl SPLACEMENT ABOUT OR ALCNG FREE COORDINATE AXES 

IFINFRC.EO.O ) GO TC 5065 
> CO 3 MK=1.NFRC 

N = NEQ ♦ MM , 

IF (SCRT ) GO TO 12 
TO IN I = AN GO I MM I 

IF(LEQU) PRINT 1C6. N.NK.YCIN) 

CO TC 3 

12 N = £ FR I MM ) 

THAI M) = YIN) 

iFiceou) print 2oe. m.n.tmaim) 

3 CCNT INUE 
5065 CONTINUE 

NEC = NEC A NFRC 

C • . ‘ • 

C 

C GENERALIZED ELASTIC COORDINATE DISPLACEMENT EQUATIONS 

IF IN RODS. EQ. C) GO TO SC6Z 

CO IS NN=1, NMOOS i 

N - NEQ +NN 

NS T 1 = nfer+nn 

IF ISCRT J GO TO 2C - 

TC IN I = THAOINSTl ) 

IFILEQU) PRINT 103. N.NSTl.YOlNl 
GO TC IS 
2 C CONT INUE 

THAINSTI) = YIN) _-f 

1 1 1 IF ILEQU ) PRINT 20C, NST I ,N , THA l NSTl ) ros r>~ ■ . 

IS CONT INUE 
£062. CCNT INUE 

NEC = NEC A NMODS 
C 
C 


C211230C 
C 2 1 12400 
C 2 1 1 2500 
C 2 1 1 2600 
C2I127C0 
C 2 1 1 2600 
C 2 112Q00 
C2 11 3000 
C2 1 1 3 100 
C 2 1 1 3200 
. C2113300 

C2 1 1 3400 
C21135C0 
C2 1 1 3600 
C2I1 3700 
C2 1 1 3600 
C2 1 1 3900 
C21I 4000 
C2 1 1 A 100 
C211A200 
C2II4J00 
C2I1AA00 
C 2 1 1 4£00 
C21XA6CC 
C2I1A7C0 
C2114600 
C2 1 I 4900 
C2115CC0 
C2 115100 
C 2 1 1 520 0 
C2 11 5300 
C21154C0 
C211 5500 
C2 1 1 5600 
0 2 C 2 11 5700 
• C2 1 1 5600- 
C211590C 
C 2 1I60C0 
C2 1 1 6100 
C 2 1 1 6200 
C 2 I 1 63C0 
C2U64C0 
C 2 1 1 6500 
C 2 1 1 6600 
C2 1 1 6700 
C 2 116800 
C 2 1 1 6900 
C2I1 7000 
C2 1 1 7 100 
C 2 1 l 7200 
0211 7300 
C211 7400 
C 2 1 1 7500 
C2117600 
" C2II 7 70C 
C2117800 
C 2 117900 
C2I13000 
C2118100 
C2 1 1 6200 


/ 


A-127 



c 

DISPLACEMENT AEOUT WHEEL SPIN AXIS 

C2 1 1 8300 


IFINMCA .EQ.O ) GO TC 5C66 

02)18400 


CO 4 MM=1 .NMOA 

C 2 1 1 8 500 


► = SMAIMM) 

C2 1 1 8600 


A = MED * MM 

C2 1 1 87C0 


IFISCRT) GO TO 13 

C2 1 18800 


TO (N ) = THADWIM) 

C2118900 


IFILECU) PRIM 108. N.M.YCIN) 

C 2 1 1 9000 


CC TC 4 

C2 11 91 00 

13 

CONT INUE 

C2 1 19200 


THAW (V) = Y ( N) 

C2 11 9300 


IF < L EQU ) PRINT 208. M.N.IFAYIM) 

C2 1 1 9400 

4 

CONTINUE 

C2 1 1 950C 

50 6 1 

CONTINUE 

C2 119600 


NEO = NEU + NMUA 

C 2 1 19 700 

C 


C2 1 1 9800 

c 

CIRECT ICN COSINES 

C2 1 l 9900 


CALL UNPACISTI .NST1.SO > 

C2 120000 


N = NEG 

C2 120100 


M = C 

C2 120200 


IFINST1 .ECI.0 ) GO TO 5C67 

C2 120300 


IF ( INERF .OR. ST 1 ( NST1 ) .NE .1 ) GU TO 5 

C2 12 0400 


NST1 = NST1 - I 

C2 12 0500 


IFISCRT) GO TO 14 

C2 120600 


M = M + 1 

C2 120 700 

1 A 

CO 8 J = 1 • 2 

C2 12080C 


CO 8 1=1,3 

02 120900 


N = N + l 

02 121 000 


IFISCRT) GO TO IS 

C2 121100 


TO IN ) = YMCOI I . J. M) 

C2 121 200 


IFILEGU) PRINT 111, N , I . « . M , YD I N ) 

C2 12 1 300 


CO TC d 

C 2 121400 

is 

XMCI I , J .M) = YIN) 

C2 121 500 


IFILEOU) PRINT 211, I , J.M.N.XMCI I.J.M) 

02 12 1 600 

■ ' e . 

CONTINUE 

C2 121 700 

c 

IFINS1 1 .EQ.O ) GO TC 5087 

02 12 1 BOO 


CO 6 MM=l.NSTl 

02 121900 


IFISCRT) GO TO 16 

C2 122000 


M = Ml 

C2 122 100 


CO TC 17 

C 2 122 200 

l e 

X = S T 1 I MM ) 

C2 122300 

17 

CO 6 J = 1 , 2 

C 2 122400 


CO 6 1=1.3 

C2 122500 


N = N ♦ 1 

02 122600 


IFISCRT) GO TO Id 

02 122700 


TO IN) = YMCOI I.J.M) 

02 122800 


IFILEOU) PRINT 111, N , I , . . W , YD I N) 

02 122900 


GO TC 6 

C 2 123000 

i e 

XMCI I.J.M) = YIN) 

C2 123100 


IFILEOU) PRINT 211. I . J . M . N , XMCI I . J .M ) 

02 123200 

e 

CONTINUE • ‘-<3 • 

; . 02 123300 

“ 5 06 7 

CONTINUE •• 

C2 123400 

: : ■ 

NEC = N ' 

02 123500 


IFILECU) PRINT 112, NEC • , 

02 123600 

'’‘We’ 

'FORMAT 1*1 SUBROUTINE SETUP ENTERED *) DMA 

02 123700 

102 

FORMAT I* YD(*,I2,*) = THACDI • ,12 . • ) = ’,D20.d) 

02 123800 

103 

EORMAT I* Y.D ( * I 2 . * ) "• THAC I • , 12, • > = *.020.8) 

02 123900 

202 

FORMAT I* T HAD! • , 12 . • ) = YI*.I2,*) = *.020.8) 

02 12400C 

104 

FORMAT I* Y0(*,I2.*) = THADDI • , 12. • ) = *.020.8) 

C2 124100 

• 204 

FORMAT 1 • HMOMI • « 12 • * ) = FLM(*,I2.*> * THACWI * . 12 ..* ) 

= * ,020.8) C 2 12 4200 
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2 C 5 

FCPMAT 

( • 

Tt- AD» < * , I 2 , 

106 

FCRM/T 

< • 

YD ( • , 

12.*) 

2 06 

FORM* r 

( • 

THA< • 

. 12. • ) 

ICE 

FCSM AT 

( • 

YD( • , 

12.* ) 

2C8 

FORMAT 

( • 

THA«< 

* . 12 , * 

1 l 1 

FORMAT 

( • 

YO( * , 

12 .* ) 

2 l I 

FORMAT 

( * 

XMC< * 

, 12. * , 

1 t 2 

FORMAT 

RETURN 

ENC 

( • 

tctal 

NLMBE 


* ) = VC * . 1 2, • ) = • ,02C .8) 

= ANGC< • . 12. • ) = •.02C.3) 

= Y ( * . I 2, * ) - • i 020 .3 ) 

= ThAC*>{ • . 12 . • > = ' , 020 • 8 > 

I = Y( • . 12. * J = * .020 .31 
= YMCCt • . 12. • . * . 12. • . • . 12. * » = 
•. 12. •. • . 12, • > = Y( # .I2,*) = •, 

R CF EQUATIONS. NEO = *.I5> 


•.C20.UI 

D2C.B) 


C2 1243C0 
C2 124400 
C 2 124500 
C2 124600 
C2 124700 
C2 124800 
C 2 124900 
C2 125000 
C2 125100 
C2 125200 


SUSRCLTINE OUTPUT 

GENERAL TYPE OUTPUT FCF NC PARTICULAR 3ATELL I T c 


IMPLICIT REAL*3( A-I-.0-2 . S ) 
LOGICAL FGl. FG2. FG3. FG4 , 


INTEGER 


F3S, INERF, RbLG. LEOU. LlMl(l) 


C2200000 
C220010C 
C2200200 
C 2200300 
C22C0400 
C2200500 
C220C600 
C2200700 
C22C080C 
C2200900 



A \fcC P < 


CTl 


CT2 , 

C T 3 

» 

CT4 

• 

CT 5 


FCCN 

• 

PCCN 

t 

C 2 20 1 000 


SCNCUM 


5CN 


SCRDUR , 

SCR 

• 

5FK0UM 


SFK 


SFK 

* 

SG 

• 

C2201 IOC 


51 


sic 


S I XDU* , 

six 

• 

5KDUM 


SK 


SL 

• 

SL K 

• 

C 220 l 200 


SMA 


5 MC DU M 


SRC . 

S M V 

• 

50 K 


SP IDUM 


SPI 

* 

SOF 

• 

C2201 300 


SCL 


Sk 


55CN . 

S£ IX 

• 

SV A 


SVE 


svo 

• 

sv i 

• 

C2201AC0 


SVM 


SVP 


£ VO , 

SXF 

• 

S XT 


TORO 


5MAL 

• 

SEU 

# 

C 2201 500 


SC 


SCO 


NFL Xd , 

£FLX 

• 

SFXM 


NMCDS 


SFCC 


see 

• 

C2201600 


I IN I T ( 

i ) 


I21NIT( 

11 

t 

SD 








C220 1 700 


T/i 


REAL *3 

* ANGC (33) . CNF (2,10) 

* FLO (2,20) , FLE (2.3,20) 

* TRACK) (23) , YI»CO (3,2,11) 


ET 1C (3,10) 
FLH <3.3.20 
R I Nl T ( 1 > 


ET MC (3.10) 


. RZIN IT ( I > 


CO.FMCN 2LU0IC/ FGl. FG 2 , F G2 . FG4 , FGa. INERF, RbLU(lO) 


C2201800 
C2201900 
C 2202000 
C2202100 
C 2202200 
C220230C 
C220240C 
C2202500 
C22C2600 
C2202700 
C2202800 
C2 202900 
C2 20 3000 
C220310C 
C2203200 


CO M MC 

/INTO/ 


A* OPK 

( 200 ) 

* 





C2203300 

A 

CT l 


* 

CT2 


. CT 3 


CT 4 

i 


C2203400 

* 

C 75 


f 

FCON 

( 23 ) 

, JCuN (10) 

f 

LCCN 

(22 1, 

• 

C220350C 

* 

MC 

( 10 ) 

• 

M31 


, NtiUL) 

• 

NCTC 


* 

C2203600 

* 

NFER 


• 

nfkc 


, NFRC 


NLOft 

. 

• 

C22037CC 

% 

NMV 


* 

NMO 

) » 

,\-l\MQA',3 =MT3?. 

TV 

TNSVP" 


"■ «/V « 

•C 220 380 0 

* 

NSVC 


« 

FCON 

(11) 

. SO 

* 

SFR 

(33) 

• 

C2203900 

* 

SG 


• 

SI 

( 55) 

. S IG 


SL 


* 

C 2 204000 

* 

SLK 

(23) 

• 

£MA 

( 10) 

. SOX (11) 

• 

SCF 

on 

* 

C2204 100 

* 

SCL 

(11) 

• 

SMV 


. SR 

• 

SSCN 


* 

C 2 2 04200 

* 

s s i x 


• 

£ VA 


. sva 

• 

SVD 


• 

C 2204 300 

♦ 

SV I 


• 

SVM 


, 5 VP (22) 

• 

svu 

( 33 I 

t 

C 2 204 400 
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n n 


c 

c 


♦ 

SXM 

<2.10) 

• 

5 X T 


. TOfiQ 

(47) 

* 

SMAL 


• 

C 220 4 500 

4 

SEU 


• 

MG 


. SC 

(33) 

• 

SCO 


• 

C2 204600 

4 

* N F L X Q 


f 

SFLX 


. SFXM 

(10) 

• 

NMCDS 


• 

C2204700 

♦ 

SFCC 


• 

see 

<10 1 







C22048C0 













C2 204900 



- 










C22050C0 


CCNMC N 

✓ INTG 2/ 










C2205100 

* 

SCNCLM 


, 

SON 

(9) 

• SCRDUM 

• 

SCR 

(9) 

t 

C 2 205200 

* 

SFKCLM 


f 

SFK 

< 9 ) 

• SIXDUM 

• 

SIX 

(9) 

• 

C 2205300 

4 

SKDLV 


• 

SK 

< 9 ) 

. SPIDUM 

• 

SP I 

(9) 

« 

C2205400 

4 

SMCCLM 


• 

SMC 

< 9 ) 





* 


C2205500 

*. 












C2205600 













C 2 20 5 700 


CO ► M C N 

/real/ 










02205800 

4 

C A 

(2.10) 

f 

CAC 

<2.10 

• CL M 

(10) 


CCMC 

(3.11) 


C2205900 

» 

D CM C 

< 3. 11 ) 

• 

ETC 

(3.11) 

• ETH 

< 33) 


FjJMC 

(3.11) 


C220600C 

4 

G AM 

(2.66) 

• 

h 


• HM 

(3.10) 


h^C 

(3.10) 


C2206100 

4 

HfrO* 

< 10) 

• 

FFI 

(2.11) 

• PL M 

(10) 


CF 

(3.32) 


C 22 06200 

.4 

QFC 

(3.33) 

• 

QL 

< 2.22) 

t QLC 

<3,22 > 


RJMC 

(3.11) 


C2206300 

* 

T 


• 



TH A 

<3J) 


ThAD 

( 32 ) 


C220640C 

4 

TH A C 14 

< 10 ) 

• 

T HA 4 

(10) 

• XD 1C 

(3.3,66) 


X I 

(3.3.10 


C2206500 

4 

X tc 

(2.3.10) 

• 

XMAS 

( 10 ) 

• XMN 

(33,33) 


XMT ' 

<3.3.10 


C2206600 

4 

T LG 

< 23) 

t 

FLA 

<2.20 

. FLB 

(3.20) 


FLC 

<3.20 


C 2 206 7 00 

4 

FLO 

( 2. 3. 20) 

t 

FL J 

(2.3 .20 ) 

• CAO 

(3.10) 


X IC 

(3.3.10 


C2206800 

4 

FL IRC 

(2.10) 

• 

FLCRC 

<3.10 

• FLAC 

(3.20) 


FL QC 

(3,20) 


C220690C 

4 

FLC M 

( 20) 

• 

ZETA 

( 20 ) 

• KCF 

(3.3,40 > 


fck ‘ 

(3,40) 


C2207000 

4 

T IMEND 











C2207100 


COKMCN /REAL2/ 

* CEDLM <1.3) . CB <3.10 . 

* XfCCIMt 1. 1 .91 , XMC (2.3,10), 


C-3C0UM < 1 .3) 
CBN < 3 ) 


CBC 


<3.101 


EOU I VAlENCc <ETM( 1 ) . THACC < 1 ) ) 

. * < X MN ( 1.3) . YMCD< 1.1,1)) 

* < XMN ( 1 .6) . ET 1C < l . 1 ) ) 

* (ELfll 1.1) ,FLO< 1.1)) 

* < F LM <1,1,1) ,FL J < 1.1.1)) 

* (fGl.UMTII )) 

* < CBOUW< i , l ) ,KZINir< 1 ) ) 

* ( SCNDCM. I Z INIT < l ) ) 


. < XMN 11.1). AN CD ( I ) ) . 

. (XMN< 1.6) • CNF ( 1. 1 > ) . 

, < XMN < 1 ,10) » E TMC < 1.1)) . 

, (FLE <1.1.1). FLD< 1.1.1)). 
« 

. (CAl 1 . 1 ) ,N INIT < 1 ) ) . 

. ( AM OR K ( 1 ) . I INIT< 1 ) ) . 


INTEGER TIN 
C l*ENS ItN PHI I <3. 2) 

CIKENSICN TOMC < 3.11) 

CINEN3ICN 5Y SCM ( 3 ) 

CIKENS1CN 5YSIN<3.3) 

CIFEFSICN HB < 3 , 1 0 ) . TK < 1 0 ) . 

CIFEOSICN PO£< 3 . 1 C ) . VEL < 2 , 1 C ) 

C I MENS I CN TfcMl < 3 ) .TEM2 < 3 ) . TEM3 < 3 ) .OEHV < 3, l I I 
CIWENSICN TEM4<3) 

CIMENSICN HBCDY<2), F I Nc RT < 3 ) 

•CIFEFSICN EP J< 3 , 1 C) ,DHF( 2. 10 ) 

DIMENSION EP<3).EI<3.3) . E ID <3. 3) .FvJCX 3) .FQDC(J) 
RE«L*3 LM< 3. 10) ,LMT( 3) 

INTEGER EfcT< 10 ) . 5FXXK ' * 


I >. 


TEM5I 3. 2 ) 


C 2 20 72 00 
C 2 20 7 300 
C 2 20 7 400 
C2207500 
C22C7600 
C 2 20 7 700 
C220780C 
C22C7S100 
C2208000 
C2208100 
C2208200 
02206300 
C2 206400 
02208500 
02 208600 
C22C8 700 

C22oaeco 

C2208900 
C2209000 
02 2091 00 
C2209200 
C2209300 
C2209400 
02209500 
C’2209600 
02 20 9 700 
' C2209800 
C22C9900 - 
0221 0000 
0221 0100 
0221 0200 
0221 0300 
02210400 
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n n n n n n n n r. nn 


i 

c 

c 

c 


1 1 


i e 
1 e 


4 


.2 1 
• 2C 
c VVV 

C 

c 

c 

c 


CONTINUE ’ C 2 £ 1 0500 

PRINT 2C2. T C 2 2 1 0600 

C221070C 


COMPETE SYSTEM COMPOSITE CENTER GF MASS 

TGTM = C.OO 

CO I 1 1 = 1 .3 

TEM 1 < I 1 = 0.00 

CO IS K = 1 . N30D 

KO = XT CINLil .0 .A ) 

CALL SCLVI XMASIK ) ,0AM< I .KOI .TLM21 

CALL VELADDI TEMI . TFM2 .TEM1 I 

TO T M = TCTM ♦ XMASIKI 

CO 1 £ I = 1 . 3 

SYSCMll) = T EM 1 ( I ) /TO TM 

PRINT 20C. (SYSCMI I) . 1 = 1 ,31 • 1 

PR INT 222 . TGTM 

’compete. SYSTEM INERTIA TENSCP A3QU T COMPOSITE CENTER OF MASS 
CALL SOLCP I S YSCM . S YSCM . TC TM .SY3I N) 

CO 4 1 = 1.3 

00 4 J=. 1.3 

SYS I M I .31 = XOICII.J.ll - SYSIN(I.J) 

PR INT 211, ( SYSINI 1 . J) . J = 1 .3) 

PRINT 212. < SYSINI 2 . J ) . J = 1 .21 

PRINT 211. (SYSINI3.J) .3 = 1.2) 

PRINT 212 


COMPLTE VECTOR FHCm' INERTIAL ORIGIN TO COMPOSITE SYSTEM 
CENTER CF MASS RELATIVE TO COMPUTING FRAME 
CALL VEC ADD! CBCI l.lI.SYSCM.CBCIl.Ol) 


FLEXIBILITY RELATEC PARAMETERS 
MN = 0 

- CO 3 C K = 1 . NO CO 

CO 32 1=1.3 , ’ ‘ . ‘ ’ 

EPO ( I .K ) = 0 . ‘ ‘ 1 

CHM ( I . K ) = 0 . 

IP ISFXMI K ) .EU. C) GO TO 3 C 

S F > M, K = SFXMIK1 

CO 3 1 1 = 1. SF X M K 

MN = MN + 1 

NF M N = NFER A MN 

CALL SCL VC THAO (NFMN » .FLACI 1 .MN ), TEMI ) 

CALL V EC ADD! EPD ( l .K) .TEMI ,EPO( 1 ,K) ) 

CALL SCLVI THADI NFMN ) .FLQC < 1 .MNl , TEMI ) 

-CALL VECAODI DHMI l ,R ) ,TEM I ,OEM( l ,K) 1 , 7/ , 7 

CONTINUE ' " ’ ■ ■' 1 -:i 

CONT INUE . 

. • 

;>!i ' < 0 I ,5. IMHO. ID 1 . f. 4.-! 

compete inertial angular momentum ano kinetic energy of eacf 

EOCY AND OF TEE COMPOSITE. SYSTEM 
•TKIN = C.DO 
CO 7 1=1.3 


C221 ceoo 
0221 C900 
C 2 2 1 1000 
C2 2 1 l ICO 
C 22 1 1 200 
C221 1 300 
C221 1400 
C 2 2 1 I 500 
C2 2 1 1600 
C221 I 700 
C221 I 800 
C221 1900 
C2212000 
C22I 2 100 
C 2 21 2200 
C 221 2300 
C 2 21-2400 
• C221250C 

C 2 2 l 2 600 
02212700 
C22I 2800 
•C22I 2900 
C2213000 
C2213100 
C 221 3200 
C 2 2 1 3300 
C 2 2 1 3400 
C221 3500 
C221 3600 
C22I 3700 
C 221 3800 
10221 3900 
C221 4000 
C 2 2 1 4 1 CO 
C 22 1 4 20 0 
C 221 4300 
C221 4400 
C 22 1 4500 
C22I 4600 
C221 47C0 
C221 4800 
C 2 21 4 90 C 
C 221 5 00 0 
C221 5100 
C22I 5200 
' C 22 1 530 0 
C221 5400 
C221 5500 
' ! * C 2 2 1 5600 
• , C221 5700 
C221 5800 
0221 5900 
C22I 6000 
C2 216 IOC 
C 221 6200 
C22163C0 
C221 6400 
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o a n n n 


? 


29 

28 


C 


1 9 

2 4 


.2 5 


26 

c 

c 


1 3 


2 7 

so ee 


c 

c 

c 


LM7( U = 0.00 ... 

hoCDX I ) = O.DC ’ 

CO 1 7 \KK= 1 • N0CD 
K=NGCC - ( kkK- l ) 

KK = K 

JK = JCCMK) 

IFCKK.NE.l) GO TO 28 

CC ?« ■ l = lij 

TEN 1 ( I i = «U MC { I iNEl ) 

C-G TC 26 
CON T INLE 

CCNPLTc. LINEAR VELOCITY CF CENTER OF .-IASS OF BODY. K PUT IN TEN 1 
IF ( PELl} { K ) > GO TO 1 9 

CALL VECR05 ( F CMC ( 1 • JK ) • C A < ( I , K ) * Tl M 1 ) 

CALL Vfc C AOIH RCMC ( I ,K ) , TEM . TEMI ) , 

CCj TC 2 A • / . * , 

CALL VcCROS (FCMC < 1 .K) ,CAC< I ,K ) , TEMI ) , 

CALL VEC AOD ( FCMC ( 1 ,NBl ) » TEN I .TEN 1 ) 

CHECK FOR END OF CHAIN 

IF(JK.cl.O) GO TO 26 ,• 

CALL VGCRUS (FCMC < I • JK ) ,CtC ( 1 • KK ) , TEM2 ) 

CALL VE C A00( TEMI , TEM2 t TGN1 ) 

KK = JK 

JK = JCCN(KK) 

GC TC 25 
CENT INGE 

imeptial position cf center of mass in tem2 

KL = K T C (NBl • 0 ,K ) 

CALL VE C A 00 ( CBC ( 1 • 1 ) • G AN ( l , KL ) , TEM2 ) - 

CO 3 I = l • 3 

PCS ( I #K ) = T r M 2 ( I ) 

VEL( I * K ) = TEMI ( I ) 

ADC RELATIVE VELOCITY CF CM, NON-ZERO IF BGCY FLEXIBLE*' 

CALL VcCADD(VEL( l »K) ,E R'D (1 , K ) * VEL (1, K ) •) • • . , ; .. . 

CO 12 1=1,3 

TEN1 ( I ) = VEL ( I • K ) » 


C 221 6500 
C221 6600 
C 2 2 1 6 7C0 
C221 6800 
C 2 2 1 6900 
C 22 1 7 00C 
C22I 71 00 
0 2 21 7200 
C221 7300 
C221 7400 
C 221 7500 
. C22I 7600 
C 2 2 1 7 700 
• . C 221 7800 

• C221 7900 
j C 2 2 1 6 0 0 0 
'• C 2 2 1 8 1 C 0 

C 22 1 e200 
C221 e300 
■C 2 2 1 8400 
C221 8500 
C 2 2 1 86 0 0 
C2218700 
C 221 aeoo 

C 2 2 l 890 0 
C221 9000 
C2219100 
C 221 9200 
C 221 9300 
C221 9400 
C 2 2 1 9 50 0 
C221 9600 
C221 97C0 
C2219800 
. C2219900 
. C 2 22 0 00 C 
C2 220 ICO 
C 2220200 

• C 2 22 0 30 0 
C22204C0 


START CCNPUTATION CF ANGLLAR MOMENTUM, LINEAR MUMENTUM 
CALL UYLCTVC XIC( 1 ,1 ,K) ,FCNC(1 , K) ,Hd( l ,K) ) 

CALL VcCDCTI FCMC( 1 ,K ) ,HE ( 1 . K ) , TK( K ) J 
CALL VECCUTC TEM l , TEM 1 , TEN ) 

TK < K J = •5D0*<TK(K) ♦ XNAS(K)»TEM) 

CALL VECRUS < TEM2 . TE m l , T EN 3 1 
CALL SCLV<XMAS(K) ,TEM3*TE«3) 

CALL VECAUJC hb< 1 , K| ,TEN3 ,He < 1 . K) > 

IF { .NOT .RBLU (K ) ) GC TO 21 ‘ 

I c (NVO.cQ.O) GCi TC 5068 

CO 2 7 N = 1 ,NMO ! t x . » 1 s/5-?r, * * * * * >•' • • . 

IF CMC ( N ) .NE. K I GO TO 27 

CALL 5CLY< HMOM(M) ,HMC< 1,N) , T EM 3 ) 

C ALL V£C ADD( HE( l , K ) , TEN 3 .HE ( 1 , K) ) 

TK(K) = T K (X ) ♦ . 5C0 *HVCM M )**2/PlM(M> ’ >' 

CC N T INUE •' 

CONT INUE 


ADC FLEXIBILITY ACCITICNS TC MOMENTUM ANO ENERGY-. 


ANC 


KINET !C C222050C 
C2220600 
C222070C 
C222C8CC 
C22209CC 
C222 1 00 C 
C 2 22 l 100 
C 2 22 1 2C0 
C 2 22 I 300 
. C2221400 

JJC2221 500 
C 2 2 2 1 60 C 
C2221 700 
~ C 2 22 18 0 0 
G2 22 1900 
C22220CC 
C2 222 100 
C2222200 
C 2 22 230 0 
• C 2 22 24 0 0 


a A } n V 
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CALL VEC ADD! He ( 1 . K ) , CHKI 1 .K I .HJ( 1 .K )) 
CALL VcCCCT<FCMC< 1 .K) .CHM1 ,K) .TEM) , 
TK(K) = TK ( K ) ♦ TEM 


C ACC LP FCR SYSTEM ANGULAR mcmcntum and kinetic energy 

TK IN = TKIN + T K ( K ) . 

CALL VcCAODt Fu< 1 . K » .HE3CCY .HEODY > 

CALL SCLV(X«4AS<K) .VEL( 1 .K).LM 1 ,K) > 

CALL VCCACDl LMT ,L M 1 .K ) ,LMT ) 

1 7 CCNT INUE • 

CALL TRNSPS ( XMC < 1 • 1 .0) ). 

CALL VECTRN < HdOD Y . XMC < 1 • 1 . 0 ) . HINEMT ) 

CALL TRNSPS. (XMC(l.l.C)) 

IF < .NC T . INERF ) GO TO 2 
CALL TmN'PS <XMC<1.1,1)) 

CALL VECTRN (HINERT.XMCI l.l .1) .HOJCY) 

CALL TRNSPS (XMC(l.l.l)) 

2 CONTINUE 

EM G = DSCR T< HI NER T< 1 ) **2 ♦ FI ilEKT ( 2 ) »*2 ♦ H I NE R T ( 2 » *« 2 ) 

FR INT 2C S , HMG ■ 

PRINT 2C1. (FEODY(I) .1 = 1 .3) 

PRINT 2 C 2 • < MINER T < I ) . I = I .3 ) 

A = CSQRTILMTI t )**2 ♦ LMT<2)»*2 ♦ LMT(3)**2) 

PRINT 217. A 

PRINT 2 IS. (LMT< I 1.1=1.:-) 

PR INT 21S. TKIN- 
C 
C 

c ccmflte inertial acceeera t i c.ns 
co a 1 = 1.3 

e tomcci.i) = ccmcii.i) 

■IF (NECU.EQ.l ) GO TO 50C1 
CO 1 A K = 2 .NBOO 

CALL VECROS (F CMC (l.K) »RCMC(1»K)»TEM1) 

14 CALL VECSU<3< OOMCI 1 .K ) .TEM .TCMCI 1,.K) ) 

SC Cl CONTINUE 

CALL VEC POS IFOMC < 1 . 1 ) .RCMC < 1 .IJU1 ) , TEM1 ) 

CALL VECSUB<OC<MC< l.NQl ). TEM l , TOMC< l .NcJl ) I 
M = l 

CO 2 C K= 1 . N 0 1 ' 

IF CK ,60 . 1) GO TO 2 1 
N = AF3-FC0N <K-l ) 

. .11 CO 2; 1=1,3 

2 2 TEM < I ) = 0 

MMTEFM = M42-PC0N<K ) 

- IF < M .G T .MM TERM ) GC'TO 20 

CC 23 MN=M,MMTERM 

CALL SCLVI THAOO(MM) , OF C < l .MM) . TEM2 * 

23 CALL VECAGLH TEM1 , TEM2, TEM 1 ) 

. 2 C CALL VEC AOU< TEM1 . TCMC< 1 ,K ) .CERV< l ,K ) ) . 

C ' . : ■ ' . ' 

c - /. - 


C 2 22 2 50 0 
C2222600 
C 2 22 2 7 00 
C 2 222 dOC 
C22229C0 
C222300C 
C2 223 100 
C 2 22 320 0 
C 2 22 3 30 C 
02223400 
C 2 22 3 500 
C2 223600 
C2223700 
C2 22 3800 
C 2 22 3 90 0 
C2 22 4000 
■C 2224100 
C 2 22 4 2 00 
C2224300 
C 2 22 4 40 0 
C 2 22 4 5 00 
C 2 22 46 0 0 
C2224700 
0 2 224 600 
C2 22 4900 
C2225C00 
C2 2251 00 
C2225200 
C2225300 
C2 22 540 0 
02225500 
C2225600 
C2225700 
C 2 2 2 580 0 
C 2 22 5900 
C 2 22 600 0 
C2226100 
C 2226 200 
C2226300 
0222 6400 
C222650C 
C 2 22 6600 
C 2 226 70 C 
02226800 
C 2 226900 
C2227C0C 
C2 22 7 10 0 
C 2227200 
C 2 22 7 300 
C 2 22 7 40 0 
■ C- 2 22 7 50 0 
C2227600 
C22277CC 


CC 5 K=l,Nc3UD . i.< , . ) irt.tii' , i .. . .-isr 1 • - - = • -.-02227800 


? " PR 1 N 1 

• 20 $; 

K . < ROMC < I ,K ) , 1=1 

.3) {<FOMC< I TK)VI=TV3) “ 

C2227900 

1C PRINT 

2C 7. 

< 3ERV< I .K ) , 1= 1 . : 

) 

C 2 22 BO C 0 

• PRINT 

<>22* 

< t TC< I .K ) . 1 = l .2) 

. <PHI < I ,K) . 1 = 1 , 3 ) 

C222W10C 

PK IN T 

2CS. 

< C AC ( 1 .K) ,1 = 1 ,3) 

, <C JC (l.K). 1=1, 3) 

C 2 22 0 20 0 

PRIM 

21 t. 

(FCS<I *N) ,1 = 1 .3) 

. < VCL < l.K), 1 = 1, 2) 

C 2 22 6 30 0 

PR IN 7 

2Ct» 

( < XMC ( I .3 • K ) ._=! 

,3) .<X1C(I,J.K>.J=1.3).1=1.3> 

. C 2 22840 0 
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PRINT 214, I H6 I J . K > . J= 1 . 3 ) , TK( K ) , 

PSINT at. ILN(J.K),J=l,;i 
5 CONTINUE 

PRINT 20 a. I FOKCI I ,NB1 > . 1 = 1 .3) . I DERVI I iNfll ) . 1=1 ,3 ) 

PRINT 222. ( ETC! I .NB1 > . I =1 .2) . (PHI ( I .NB1 > .1 = 1 .3) * 

PRINT 224. ( CBC (I. Cl. 1 = 1.2) 

PRINT 221. I <XMC( I . J .0) . J=1 .3) .1=1 .2) 

PRINT 212 

", IF (NPG.k~C.01 GC TC 41 
CO 6 F = 1 .NMD 

PRINT 2 1 C , M .FtMOMIM) ,M ,CLM( M) 

■ e CONTINUE 
4 1 CO N'T I NUc 
PRINT 212 

„ ;• IP(NKCOS.EO.O) GO TO 40 

CALL. UNPACISET.NSET .SFLX 1 • 

' - • • hn •= 0 

CO 32 KK=1 ,NSET 
K = SET INSET * 1 — KiC ) 

CO 34 1=1,3 
EPII) = C 
FOCI I » = 0 

race 1 1 ) = o 

' CO 3 4 J= 1 , J 
E I < I . J ) = 0 

eici i ,j) = o 

34 CONTINUE 

SFXKK = SFXM(K) 

CO 3: M= l , 3F XMK 
MN = M N-* 1 
NFMN = NFER+MN 

CALL SCLVI THAI NFMN) ,FLA( l ,MN> , TEM1 ) 

CALL VECAODl EP ,T£M 1 ,EP > 

CALL SCLVI TH AD I NFMN) . F LQ I 1 . K N ) . TE M 1 ) 

CALL VECADDI FQO. TEM1 ,FCC ) 

CALL SCLC I THAI NFMN) . FLE I 1 . 1 . MN ) . TENS) 

CALL CYACDIE l.TEMS.EI > 

CALL SCLCt THADINFMN) , F LE « 1 . I .MN) , TEM5 ) 

CALL DYALCIEID.TEM5.EID) 

1 3 5 CONTINUE 

PRINT 22C , IEPI I ) .1 = 1 .2) .lEPDI I .«> . 1-1 .3) 

PRINT 22 E • N . (FOD I I ) , 1 = 1 .3) 

PRINT 22 Si I IE I II . J) . J- l .3 ) ,1c. ID! l . J) . J = l . J) . 1 = 1 . 2 ) 

PRINT 22C. I FL IRC I I .K ) . 1 = 1 .2 ) . IFLCRCI I .K> ,1 = 1.3) 

FRINT 22 1 . IDHMI I . K ) . 1 = 1 . 2 ) 

32 CONTINUE 
PRINT 2 12 
4C CONTINUE 

CO 9 I=1.NFER- • 

9 PR IN T 22 C. I I . THA I I ). . I . T FAD I l ) , l ,TH ADD! I) . I . IOFC I J. I ). J = 1.3)) 
N1 • = NFEPF.L . • r 

N2 = NFEPFMN 
* IF (MN .EU .0 ) ' RE TURN 

CO 12 I = N1 , N 2 ... 

<■ 'T2 (PRINT 22E. I , THA I I ) . I , T F AD (I ) , I , TH ADD I l ) 

2 0 C FORMAT I* CENTER CF MAES = • ■ 3D 1 7 .8 . / ) 

201 FORMAT I/.3X, 'FOODY = '.2C17.d) 

202 FORM AT I 3X, * HI NERT = • .301 7.8 ) 

203 FORMAT I '1 TIME = ; '.DI-5.E./) 

204 F0RMATI/.3X. 'BODY ■ , I 2 .4 X , • ROMC = • , 3D 1 7 . 8 . Jx , • F CMC =',3C17.8) 


C 2 22 8500 
02228600 
02 22 6700 

C222eeoo 

C2228900 
C2 229000 
C2229100 
C22292CC 
C2229300 
C2229400 
C22295CC 
■ C2 22 960 0 
C 2 2 29 70C 
> C222980C 
C2229900 
-C2230000 
C223C1 00 
C 2 230200 
C 2230 30 0 
, C2230400 
C 2 230 SCO 
C223060C 
C2230700 
C22 30800 
C 2 23090.0 
C223I 000 
C2231 1.0 C 
C2231200 
C22J1 3CC 
C223 1 400 
C2231500 
C223160C 
C22J1 700 
C 2 2 3 1 800 
C2231900 
C2232C00 
C22321 00 
C 2232200 
C2 23 230 0 
C22324CC 
C2232500 
C 2232000 
C2232700 
C 2 23 2 80 0 
C2 232900 
02 233000 
C2233100 
C2233200 
C 2 23 3 300 
C 2 23 3 40 0 
. C 2 233 50 C 
C2 23 36 00 
C22337C0 
C 2233800 
02233900 
C2 234000 
C2 234 IOC 
C223420C 
. C 2 2 34 30 0 
C2 23*4400 


A-134 


u u u 


2C 5 

FORM A T 

( 14X. 

•CAC = • .30 1 7 .8 .3X . • C0C = • .301,7*3) 


C 2234500 

ace 

FOP MAT, 

I 14x. 

•XMC = • .30 1 7 .3 , 3X . • Xl C = • .3017.8) 


C2234600 

a 0? 

• F.O PM AT 

( 1 4 X . 

•ACC = • .301 7.u ) 


C22347C0 

act 

FORMA f 

( / . JX 

. *0P1 GIN • .4* . 'FCMC = .3017. J.3X. ’ALL = 

• .3017.6) 

C22348C0 

205 

forma t 

(• ANGULAR MOMENTLM = •. 020*3) . 


C 2 234900 

21 C 

FG RM 4 T 

( 3X. ' 

HMCMC *. 12. • ) = * .01 7. d , 10X , *CLM( • . I 2. • ) 

= • ,017.81 

C 2 23 5000 

2 1.1. 

FORM A T 

126X, 301 7. d) 


C 2 23 5100 

2 1 2 

FOP MAT 

(• SYSTEM INERTIA TENSOR ='.301 7.8) 


C223S200 

2 1 j 

FORM 4T 

< * * 

) 


C223S300 

2 1 4 

FORMAT! 

1 4 X , * 

Hd = • . 30 17 .8. 3X. ' TK. = * .017.8) 


C2235400 

2 15 

F0PM4T 

I/.* 

KINETIC ENERGY = *,D20.b) . , 


C2235500 

2 1 t 

FORMAT 

1 14 X. 

•PCS = • .301 7 .6 .3X . • VEL = • . 30 17.3) 


C2235600 

21 7 

FORMAT 

1 /. * 

LINEAR MOMENT UM = ••020.3) 


C2235700 

2 16 

FORMAT 

( 14X, 

• LM = • .30 1 7 .8 ) 


C2235800 

2 i <; 

FORM AT 

( / , 3X 

. *Lti JCY =*.3017.81 


C2235900 

2 20 

FORMAT 

(3X. • 

THAI*. 12.*) = • .013.6. 3X . *ThAO( *. 12. * > = * 

, 6.1 2 .6. 2X . • 

THAC22360CO 

*C0 ( • . 12 

. * ) = 

• ,01 3 .6. 3X . • CFC < • , 12.*) = • .3013.6) 


■C2236100 

22 1 

FORMAT 

( 14X. 

• XMC = *.3017.8) 


C2236200 

2 22 

FORMAT 

( ’ 

TOTAL SYSTEM MASS =*.017.3./) 


C2236300 

223 

FORMAT 

( 14 X . 

•ere = * . 30 1 7.6 . 3X , • PH J = *,3017.8) 


C22364C0 

22 A 

FORMAT 

( 14X , 

•CdC = *,3017.8) 


, C2236500 

22E 

FORM AT 

( 3X. • 

THAI*. 12.*) =• .Cl 3.6.3X . *THAO< • , 12. • ) = * 

, 01 ’ .6. 3X , • 

THAC2236600 

*CC ( • , 12 

. * ) = 

• ,013.6) 


C2236700 

226 

FORMAT 

l / • 3X 

. * FLE X I6LE * . 2X . • EP = • , 30 1 7 . 8 . 3X , • EPP = 

■ . 3017 .8 ) 

C2236HOO 

'2 2 6 

FORM AT 

< 2X. • 

80UY * . 12 ,4X . ' CO = *.3017.8) 


C2236900 

225 

FORMAT * 

( 14 X t 

• El = • .3017.8.3X. *EI0 = *.3017.8) 


C2237C00 

2 3 C 

format 

( 14X. 

•FIR = • .3C17.6.3X, *FCR = *,3017.8) 


C22371 00 

'2 3 1 

FORMAT 

( 1 4 X . 

•OHM = • ,301 7.8) 


C22372CC 


RE TORN 




C 2 237300 


'£ N C 




C2237400 


J2i\ 


SUERCuriNfc UUTPSP 

d*E KE K A L TYPE OUTPUT FCR NC PARTICULAR SATELLITE 


IMPLICIT KEAL»8( A-H.O-Z . * I 

LOGICAL- FG 1 , FG2. FG3-. FG4, F . I NtlMF « RdLG, Lt GU . ,L l N I T{ 1 j 
C . 

c •• ' 

: INTEGER 


' A 

A *ORK 

, CT1 

* 

SCNCLM 

. SCN 


S I 

• S IG 


SVA 

* SMC 0 U V 


SCL 

• S H 

: V 

S VM 

. SVP 


5 C 

• S CG 


» i in i r t i > 

c oct t rr- st 

c 

c 


C T 2 . 

C 73 

* 

CT4 


CT5 

FCCN 

• 

PCCN 


SCR DU V • 

SCR 

t 

SFKOUM 


SF K. ■ 

SF R 

• 

SG 


s i xouv . 

SIX 

• 

SKOUM 


3 K • 

SL 


SL K ' 


SMC • 

. SMV 


SCK 


5P.I0UM* 

SPl 

t 

SQF ■ 


S SC N • 

S S l x 

• 

SVA 


SVB t 

SYO 

• 

sv. i ' ‘ 


SVQ • 

sxv 

• 

SX T 


TORO • 

smal 

• 

SEU 


NFL XQ , 

SFL X 

» 

SFXM 


NMOOS • 

SF C C 


SCC : . 


UINIT( 

1 ) 

• 

SD 








« LJ 

< I I.'lUAf .T , 1 . ( I ) OF -) T. ; r.! 1 ,t'-T . 1 



real *a 







♦ 

ANGC 

( 23) 

• CNF 

( 2, 1C ) . 

E T IC 

(3,10) 

ETMC (3. 


FLO 

< 2, 20 7 

> Ft E * 

(2.3,20) . 

flh 

(3,3.20). 

: 

* 

TRACT) 

( 23) 

* YMCO 

(2.2.11), 

RINIT 

( 1 ) 

RZIN IT ( 1 ) 


C22COOOO 
C23CC1CC 
C2200200 
C2200300 
C2 300400 
C23C0600 
C23CC600 
C2210700 
. C22OO0OC 
C2200900 
C2301C00 
C 23 01 100 
C2301200 
C22C1300 
C 2 30 1 400 
C2301 500 
• C2301 600 
C 230 1700 
'C 2-3 Of 00 0 
C220190C 
C2302000 
-C 2302100 
C 2302200 
C23023C0 
,C 2 3 02 AO 0 
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n o 


c 

c 

c 

c 

c 

c 

c 


C220250C 
C 2 20 2600 
C23327C0 
C 2 202800 
C 2 202900 

CCVMCN /LOGIC/ Full FG2. FG2. FG4 , FGS. INEFF. KeLC(lO) C2203000 

C2203100 
C 2203200 


CCVMCN 

/ INTG/ 

A iQRK 

( 200 ) 

» 




C 2 203 300 

* 

C T1 


• CT2 


• C T 3 


» CT4 


. C2303400 

♦ 

C T 5 


• FCON 

( 23 ) 

.* JCCN 

(10) 

. LCGN 

(22 > 

. C2303E00 

,4 

VC 

( 10) 

• NE1 


• N'300 


* NCTC 


, C 2 20 3600 

* 

NFES 


. M FK C 


• NF RC 


t NLOK 


, C2203700 

* 

NV V 


• NMC 


• N MG A 


• NSVP 


. C2203600 

% 

NSVC 


• FCON 

( 11 ) 

* sc 


• SFR 

(33) 

, C 2 30390 0 

,4 

SG 


• S I 

( E£) 

. 5 I G 


• SL 


. C 2 204000 

4 

SLK 

(23) 

• S M A 

( 10) 

• 5G K 

(11) 

• SGF 

(11) 

. C2204100 

* 

SCL 

( 11 ) 

* SMV 


* SR 


» SSCN 


. C 2 204200 

♦ 

S= IX 


• S VA 


• SVB 


. SVC 


, C 2 204 300 

* 

SV I 


t SVM 


• SVP 

(22 ) 

• SVQ 

( 23 ) 

. C2304400 

♦ 

SXM 

(2.10) 

• S XT 


. TORO 

(97) 

* SMAL 


, C2304600 

♦ 

SEU 


• MQ 


. SC 

(33) 

» SC G 


, C 2 20 4 60 0 

* 

NFL >0 


• sax 


• sfxm 

( 10 ) 

• NMCOS 


. C22047C0 

* 

SFCC 


• see 

(10) 





C2204800 


C2 304900 
C 2 205000 


CCVMCN /INFGZ/ C220S100 



4 

SCNCUM 

. 

SCN 

( 9 ) 

. 

SCRDJM . 

SCR 

( 9 > 

* 

C 2205200 


* 

SFKCLM 

• 

SFK 

( 9 1 

» 

SlXDUM % 

S l X 

(9) 

• 

C 2205300 


* 

SKOLV 

. 

SK 

(9) 

. 

SP1DGM • 

SP1 

(9) 

• 

C 2 205 40 0 


4 

SVCCLM 

* 

SMC 

( 9 ) 







C23055C0 

c 












C2305600 

c 












C2 20 5 70 0 



COVMCN /FEAL/ 










C22058C0 


4 

CA (3,10) 

t 

CAC 

(3.101 


CL M 

( 10> . 

CCMC 

(2.11) 

♦ 

C 2 2 05900 


4 

OCMC (2,11 ) 

. 

ETC 

(2.11) 


ETM 

(32) 

FCMC 

(3.1 1 ) 

* 

C 2 206000 


4 

Gam (2,66) 

. 

h 



MM 

(3.10) . 

HMC 

(3.10) 

• 

C2 306 10 0 


* 

H VC V ( 10 ) 

. 

Fhl 

(2.11) 


plm 

(10) 

CF 

(3.32) 

• 

C 2 2 06200 


♦ 

GFC (3,33) 

. 

CL 

(2.22) 


GLC 

(3.22) 

ROMC 

(3.1 1 ) 

* 

C2306300 


* 

T 

. 




T HA 

(33) . 

THAO 

;( 22 ) 

♦ 

C230640C 


4 

Tt-A CW ( 10 ) 

. 

TFA* 

(10) 


XGIC 

(3.3.66) . 

X 1 

(3.3.10 

• 

C2206500 


4 

X IC (2.3.10) 

. 

XMAS 

((C) 


XMN 

(33.33) . 

XMT 

(3.3.10 

• 

C2306600 


4 

T LG ( 23 ) 

. 

FLA 

(2.20 


flg 

(3.20) . 

FLC 

( 3.20 ) 

• 

C22067C0 


* 

FLO (3.3.20) 

. 

FL J 

(3.3 .20 ) 


C AG 

(3.10) . 

x ic 

(3.3,10 

* 

C2 306800 


4 

FLIFC (3.10) 

. 

FLCRC 

( 2« 1C ) 


flac 

(3.20 . 

FLUC 

( 2.20 ) 

♦ 

C 2 306900 


4 

FLCV (20) 

. 

ZETA 

(20) 


FCF 

(3.3 .40 ) . 

FCK 

(3.40) 

• 

C2 20 7000 


4 

T imend 










C2217100 

c 












C 230 7 20 0 

c 












C2307300 



CCVMCN /FEAL z/ 










C230740C 

■ - 

•* 

CECL.v (1.3) 

. 

ce 

(2.10 

. 

C DC DU M ( 1 . 3 ) . 

CBC 

(3.1 0 ) 

*• ' 

C2307500 


4 

XVCClM (1.1.9) 

. 

XMC 

(2.3,10) 

. 

CdN(J) 




C2207600 

c 












C2207700 

C.K. 

j _ 










C2207800 


EQUIVALENCE (LTM( 

l ) . THAOC( 1 ) ) 



• (XMN (1*1) 

* AN GO ( 1 

) ) 


C23C7900 


♦ 

( XMN ( 1.3). 

Y V CD ( 1.1. 

1 ) ) 

. ( XMN (1.6) 

. CNF ( 1 . 

1 ) ) 


C 2 20 800 0 


4 

( XMN ( 

l . a ) . 

ET IC ( 1 . 1 ) ) 


, (XMN( 1 . 1 C) ,ETMC( 1.1)) . 


C230B 100 


4 

( FLti ( 1 . t ) . 

FLQ( 1.1)) 



. (FLE (1.1. 

1 ) . FLD ( 

1.1.1)). 


C2308200 


4 

(FLH( 1,1.1 

) ,FL J(1 . 1 

. 

1 ) ) 

. 




C 2 30830 0 


* 

(FG1 , 

LINIK1 )) 



. ( C A { 1.1). 

9 IN IT ( l 

) ) 


C220840C 
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ononrino nnn n n "nn 


( C6DUM ( 1 . 1 ) . RZ IMT ( l ) ) 
< SCNDLM, IZ IN IT ( 1 ) ) 


. (A«QKK( 1) . 1 INIT( I ) ) 


C I MENS ICN PH l l (3 . 3 > 

CIMEN31CN TUMCI3.il) 

CIMENSICN SYSCM(3) 

CIMENSICN SYSIN(3.3) 

CIMENSICN Hb(3 .1 0 ) .TKC 1C > 

CIMENSICN POST 3 . 1 C) . VEL1 3. 1 C ) 

CIMENSICN TEM1 < 3) . TEM2 <3 1 . TE M3 ( 3) .OErtVT 3 . 1 1 ) 

CIMENSICN TEM4(3) 

CIMENSICN HcsOD Y ( 3 ) , PIN£RT(3) 

CIMENSICN EPC(3.l C) ,DHM(3. 1C > 

CIMENSICN EP(3) ,E I (3.3 > .EIC (3. 3) ,FCD{3) ,FGCC(3) . T EM 5(3*; 
INTECER SETT 10 ) i SFXMK 
REAL»a LN( 3, 10) ,LM1( 2) 

IN T E CEP T 1 K 


1 CCNTINUE 

PRINT Z 03 * T 


CCMPUl system composite center cf mass 

TO TM = C.DO 
CO 11 1=1.3 

II TEMIII = 0.00 
CO 1 £ K = 1 .NdCO 
KO = KT C (Nol , 0 ,K ) 

CALL SCLV( XMAS(K ) ,GAM( l ,KC > ,TEM2 >. 

CALL VECAULX TEMl , TEM2 ,TEM1 ) 

1 £ TO T M = TCTM + XMAS ( K ) 

CO 1 £ 1 = 1.3 

1 t SYSCMI) = TEM1( I l/TCTM 

PRINT 2CC. ( SY SCM ( I) ,1 = 1 ,31 
PRINT 222. TCTM 


COMPUTE VECTOR FRCM INERTIAL JRIGIN TO COMPOSITE SYSTEM 
CENTER OF MASSRELATIVE TC COMPUTING FRAME 
CALL VECALOl CBC( l .1 ) ,S YSCM ,C0C ( l .0 ) ) 


COMPOTE SYSTEM INERTIA TENSOR AdUUT COMPOSITE CENTER OF. MASS 
CALL SUEGP ( 5 YSCM , SY SCM, TCTM, SY SIN) 

CO 4 1= 1.3 

CO 4 0=1,3 

4 SYSIN(I.J) = XDIC(I.J.l) - SYSIN(I.J) 

PRINT til, (SYSIN( 1 .0) ,0=1 .3) 

-PRINT 2'1‘2 .< ( SYSIM2, J > . J = I .3 > ' 1 - ‘ ~ •' ( >' ‘ 

PRINT til, ( SYS IN( 3 . J 1 . 0= I .3 I 
PRINT t 1 3 

C.' . 

C 

C FLEXIBILITY RELATEC PARAMETERS 

MN = 0 

CO 3 C K=l,NBUO 
CO 3 2 I = 1 , 3 


(23CE500 
C 2 30 860 0 
C22C8700 
C2 3C8800 
C23C8900 
C 2 30900 0 
C2 309100 
C23C9200 
C23C9300 
C2239400 
C 2 309 500 
C 2 30 9t>0 0 
C23CS700 
C23C9800 
C2309900 
C231 0000 
C23I0100 
C231 0200 
C 2 31 0300 
C231 04CO 
C2310500 
C 2 3 1 0600 
C231 0700 
C23I 0800 
C221 0900 
C231 1000 
C 2 3 1 1 100 
C 22 l 1200 
C 2 31 1 300 
C231 1400 
C231 1 500 
C 221 1 600 
C221 1 700 
C221 I 800 
-4 C 22 1 1900 
4 C221 2000 
C2312100 
C231 2200 
Ct 312300 
C 2 31 2400 
C 23 1 2500 
C23I 2600 
C2 31 2700 
C221 2800 
C231 2900 
C231 3000 
C231 31 00 
C231 3200 
C231 3300 
C231 3400 
C2313500 
* C231 3600 
C2313700 
C231 3800 
C231 2900 
C 2 2 1 4000 
C2314100 
C231 4200 
C231 4300 
C 23 1 4400 
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£PC< I .< ) = 0 . ' ' • - " 

'22 CHM( I,M = o . 

IF(SFX.4{K I.lO.C) GO TO 3 C , • t 

SF'XH* = 5FXM1K) ' 

• co ; i i = l . sf > m k . -* • * , r . 

• MN = MM* 1 ■■■’•* • 

NFVN = NffcK * MN 

CALL SCL V( TH AD ( NFMN ) , FL AC ( 1 .MN 1 . TEM1 ) • • . 

CALL VECAODIEPDI i .K> .TEM1 .EFDI 1 . K » ) ' 

CALL SCL VC TMAC ( NFdM .FLOC ( I . K.M ) . TEM1 ) 

’■ CALL ViCADDI OHM< 1 ,K 1 .TEN 1 .DHM.I 1 . K1 ) 

31 CC M I N UE 

3 C CONTINUE ' 

c- •• 

c • 

C • 

C' 1 :' V- LCOf'PL Tc I NEK T 1 AL ANGULAR MCMENTUM AND KINETIC ENERGY OF EACH , 

C • EOCV AND OF THE CCWPCEITE S V 3 T E M 

TKIN = C.DO 

CO 7 1 = 1 , 3 ' 

LMT( I J = C.DO . - - > -• 

7 H 8 CD Y ( 11 = 0 .DC , 

'CO 17 KKK=l,NOUO •' ’ • . 

• K=NBCO- ( KKK- 1 ) 

KK - K 

JK = JCCM K ) •’ ■ -• • 

’ IF(KN.Nl.I) GO TO 2d 
CO 29 1=1.3 

29 TEM1C11 = RUMCII.NEl) '■ 

co tc a • - 

• ' 2 £ CCNT INOE . i ■ 

C • COMPETE LINEAR VELOCITY CF CENTER OF MAS 3 UF'DUDY K RUT IN TEMl". 
-IF (RELulK) ) GO TO 19 ' -• - 

■ . C CALL VC CR03 <F CMC < 1 . JK ) ,CAC ( 1 . rO , TEM1 ) 

CALL VE CAODl ROMC ( 1 .K ) . TE M . TEM1 ) 

' ■ GO TC 2 A •.•.;■■ 

.19 CALL VECFOS (FCMC ( 1 i K) . C AC ( 1.KI.TEM1)’. . . 

24. C ALL V£CADD( RCMCI 1 .NB1 ) . TEM1 .TEM1 J , . ^ 

C -'CHECK FCR End CF CHAIN 

2E IF(JK.EC.O) GO TO Et - . 

CALL VECFOS (HGMC ( 1 . JK ) .CEC ( 1 ,KKI , TEM2) . . .; 

. CALL VEC ADO ( TEM1 . TEM2 . TEH I 

’■ >•’ :kk = jk . . . .. 

• -• . JK. = JCCMKK ) - 

■ CC TC EE 
2 C CONT INLE 

c . 

C INTER T l AL POSITION OF CENTER JF MASS IN TEM2 

' KL = KT 0 <N01 . C »K ) 

• CALL VcCACDl CEC! 1 .1 ) .GAM( 1 ,KL) , TEM2 ) < • 

CO 3 1*1.3 ... 

. FOS(I.n) = TEM2I I ) - i 

• 3 VEL(I.K) = TfMK I » - .12. ; 

C ' J 

C"”9'c;' I>HU.tJi.J))Wa.O|.| )0*O=>) LOCOS-; 

C ACC RELATIVE VELOCITY CF CM. NON-EERO. IF BCCY- FLEX 1 eLE , _ 

CALL VELADDI VEL( 1 .K) .EFC ( l . K > , VELI 1 .K) ) 

CO. 13 1=1.3. . ...... 

-.12 TEMl(I) = VEL(l.K) f ...... 

C / 


C23I 4500 
C221 4600 
C221 4700 
C22I 4800 
C221 4900 
C221 5000 
C2215100 
C 22 l 5200 
C 231 530 0 
C221 5400 
C 231 5500 
C221 5600 
C231 5 700 
, C231 5800 
C221 5900 
i C221 6000 
C 2.2 l 6 100 
C 2 2 I 6 2 C 0 
C 2 2 I 6 20 0 
C22 1 6400 
C,221 £500 
0221 6600 
C2.31 6 70 0 
C221 6800 
C221 6900 
C 2 21 7000 
C2 31 7 ICO 
C2217200 
C231 7300 
C231 7400 
C 221 7500 
C 2 2 1 7600 
C 2 2 1 7700 
C231 7800 
C 2 2 1 7900 
C221 8000 
C221 81 00 
7221 e200 
C22183CC 
C231 8400 
C22185C0 
0221 8600 
C221 8700 
C221 8800 
C 22 18900 
C221 9000 
C221 9100 
C221 9200 
C221 9300 
C231 9400 
C231 9500 
. C 22 19600 
' C221 9700 
C2219800 
, 0^19900 
'1:2320000 
C222010C 
. C 2 2 20 20 0 
C 2 22 0300 
• C2220400 
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C START COMPUTATION OF ANGULAR MOMENTUM. LINEAR MOMENTUM 

■ CALL OVCCTVI XIC< 1 .1 .K ) ,FCMC I 1 . K> .HOI 1 ,KI) 

CALL VECCCT1 FCMCI 1 .K ) .he I 1 . K ) , TKIK) > 

CALL VECCOT1 TE'Ml . TEM1 , TEM) 

TK CX ) = .SOO*ITKIK) + XMASIK)«rEM) 

CALL VcCROS ITEM2 ,TEM1 .TEM3 I 
*• CALL SCLVI XMAS(K ) , TEM3 .TEM3 ) 

CALL VEC AOO( HE! 1 . K) . TEM3 .FBI 1 . K) > 

IF ( .NOT .ROLL) (K ) ) GC TO 27 

IFINMC.EO.O) GC TC 5066 

CO 27 M = 1 • N MO 

IF IMC (M ) .NE.K) GO TO 27 

CALL SCLVtHMCMIM) ,HMC( 1 .Ml ,TEMJ) 

CALL VECADDI HBI 1 .K ) , TEM3 ,FE 1 1 . Kl I 
TKIK) = THU) + .5C0*HMC M( M)*«2/PLM{M) 

- 2-7' CONTINUE 

'SO o E -CO NT INUE . , 


ANC K I NE T 1C C 2220 500 
C2 22 060 0 
, , . . C 2 32 0 70 0 

C232C6C 0 
C22209C0 
C222 1000 
C2221100 
C2321200 
02 32 1 30 C 
C 2 22 1400 
C 2 22 1500 
02321,600 
C2221700 
C2221800 
0232 1900 
C2 222000 
. - C2222100. 


ADC FLEXIBILITY AOOITICNS TC MOMENTUM ANO ENERGY 
CALL VECADDI H6(l .K).DHM( l.KI.HdU.lO) 

CALL VECCCTIFCMCI 1 ,KI.OHM(l ,K) » OEM ) 

TKIK ) = TKIK) ♦ TEM 


ACC LP FCK SYSTEM ANGULAR MOMENTUM AND KINETIC ENERGY 
'TK I N = TKIN ♦ TK ( K ) 

CALL VtC AUDI he < 1 . K ) .FBCCY.FeCDY ) 

CALL SCLVI XMASIK ) .VELl 1 .K) ,LMI 1 ,K) ) 

CALL VECADDI LMT ,LM( 1 . K ) ,LMT) 

1 7 CONT INUE 

CALL TRNSPS (XMC(l.l.C)) 

CALL VECTRN IHBODY.XMCI 1 .I.CI.HINERT) 

CALL TRNSPS IXMCI1.1.C)) . ' . 

IF! .NOT . INERF ) GO TO 2 
' CALL TRNSPS I XMC1 1.1.11) 

call VECTRN IHINERT.XMCI l.I ,1) .HeODY). . 

CALL TRNSPS IXMCI1. 1.1)1 
2 CCNT INUE 

FMC- = OSGRTI HINERTI 1 ) **2 ♦ F I NcRT I 2 ) **2 ♦ H i NE RT l 3 ) ** 2 > 
PRINT 2C9, HMG ' 

PRINT 201. IHECDYI I) .1 = 1 .2) 

PRINT 2C2, I HINER Tt I ) . 1= 1 . 2 > 

A = CSQR T IlM T< 1 ) *«2 + LMT12)*»2 + LMTIJ)*»2) 

PR INT ,2 1 7. A 

PRINT 219. ILMTI I ) .1 = 1 .2 > 

PRINT 215. TKIN 

C . 

c 

C COMPUTE INERTIAL ACCELERATIONS 


, C 2222200 
C2222300 
C2222A00 
C2222500 
C 2 22 2 60 0 
C2 222 700 
. 02222800 
C2222900 
0 2 32 3000 
023231 00 
0 222 32 0 0 
*02223300 
C2223A0C 
C2 32 3500 
02 22 3600 ■ 
C22237C0 
02223600 
V C 2 22 390 0 

C222400C 
- C2224100 
C 2 32 420 0 
C222430C 
02224400 
C 2 324500 
C2324600 
02 22 4 700 
C2324800 
C222490C 
• C 2225000 
C232SIC0 
C2225200 
0232 5300 
C 2 22 54 00 


CO 8 1=1.3 

"-' k e TCMCII.I) = OCMC1I.I) 

IFlNECD.EQ.il GC TC 5001 
CO 14 K=2 .N8QD 

^ CALL VECROS IFCMCI1.K) .RCMC11.KI.TEM1) 

14 CALL VECSUBI OCJMCt 1 .K I . TEM l .TCMCI 1 . K )) 

5001 CONTINUE 

CALL VECROS IF CMC! 1.1 I . P CMC I 1.ND1) . TEM 1 I 
CALL VECSUBI OOMC I 1 ,N81 I . TEM 1 , TOMCI 1 .Ndl I ) 
M - 1 


02325500 
C232S6C0 
C 2 32 5 700 
02 22 580 0 
02 225900’ 
C 2226000 
02 226 100 
C 2 32 6200 
C232630C 
C2 226400 
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CO 2C Ml ,Ndl 

IFIK.EO.I) GC T0 21 * ’’ 

t> = N* 3-FCGNIK-1 ) 

■ 2 l CO 2 2 1 = 1,3 

• 22 tEHtll a 0 

FMTEPM=F-f2-PCON <K ) >' ■ 

. IF <M ,GT .FMTERM ) GC TO 20 . . ....... 

co 2 ; MF=M,MMT£RM 

CALL SCLW THADDX MM) ,QFCX I ,KK1 , TEM2) 

23. CALL VECADDX TEM1 . TEM2 .TEM I •- . . 

2C. CALL VECADDX TEF1 . TCMCX 1 ,K ) .CERVX 1 ,K > ) ’ 

C 

c ■ . . ...... 

CO 5 K=I.NB0D 

K.IKUMCII.K) ,1=1.3) , XFCMC X I . <) . 1= 1 . 3) 

X DER V ( I .K ) , 1= 1 . 2 ) 

< ETCX I .K ) . I = 1 ,= ) , (PHI X l .<) . 1 = 1 .3) 

< CAC( I ,K) . I = 1 ,2 ) , (C JL( I ,K) . 1 = 1 .3 ) 

( PGSX I ,K) , I = 1 ,2 > . < VELX 1 ,K > . 1 = 1 .3) 

< XXMCX I .J.K > . J=1 .3) . (XIC( I ,J .*), J=i .3) . I = 1 .3 ) 
( HBX J , K ). J=1 . 2 ). TKX K) 

( LMX J . K ) . J=1 ,2 ) 

( FCMC( I.NB1 ), 1 = 1 ,3) , X DERV X I , N d 1 ) ,1=1,3) . 

X ETC! I .N81 ) , I =1 .2) . (PHI ( I ,Nbl ).,I= 1.3) 

X C8C< I, 0,1 = 1 .3) 

( XXMCX I.J.O ) ,J=l ,3) .1 = 1 ,3) 

IFXNNC.EC.O) GC TC 41 
CO 6 X = 1 , NMO 

PRINT 21C. M ,HMOM<F) .F.CLFXF) 

6 COM IN UE ' ' 

FR IN T 2 1 2 . . 

4 1 CCNT INUE • 

IF IN HODS ,E0. 0) GO TO 40 ' , 

CALL’UNPACI SET .NSET .SFLX ) 

FN = C . ' .. .... .. .. 

CO 3 2 KM1 ,NSET 
K = SET XNSET + 1— KK ) 

CO .34 1 = 1,3 
EP ( I ) = C 

FQC C I ) = 0 ...... ......... 

>QCC XI) = 0 : ' •. 

CO 34 J= 1.3 

ex (i ,j) = 0 

EIC(I.J) = 0 

24 CONTINUE • 

SFXFK = 3PXM(K) 

CO 3S F=l,jFX»K 
MN = MN*1 
NFFN = NFERFMN 

CALL SCLVXTHAXNFMN) ,FLM 1,MN).TEM1 ) 

CALL VcCADOIEP.TEFI.EP) 

CALL SCLVX THADINFFN) ,FLQ( 1 ,FN) ,TEM1 ) t 

CALL VECAOOX FQO, TEFl ,FGD ) 

CALL SCLC ( THAI NFMN ) ,FLE( 1 , 1 .F.N) , TEM5) 

CALL CYACDXE I . TEME ,E I > 

CALL 3CLCX TH ADXNFFN) ,FLE X l . I .MN) ,TEF5) 

CALL CYACCXE ID.TEFE.EIC) " 

35 CCNT INuE 


. PRINT 204, 
10 PRINT 207, 
....PRINT 222, 
PRINT 2CE. 
PRINT 21 C. 
PRINT 2Ct. 
PR IN T 2 1 4 . 
PRINT 2 1 £ . 
5 CONTINUE 
.PRINT 2CE. 
PRINT 222. 
PRINT 224. 
PRINT 221. 
PRINT 212 


C2326500 
C 2 22 660 0 
C2 226700 
C232t800 
C2226900 
C2227000 
C2 2271 CO 
C 2227200 
C2327300 
C222 7400 
C2227500 
C 2 22 7600 
C222 7700 
02227800 
C2327900 
C 2 22 8C0C 
C2228100 
C2228200 
C 2 228 300 
C2 228400 
C2328500 
C2228600 
C2328700 
C2228800 
C2228900 
C2329000 
C2 22 9100 
C 2229200 
02329300 
C2229400 
C2229500 
C2 32 9600 
C 2 229 700 
C222980C 
C 2 22 990 0 
C223C000 
C2330100 
C 2 2 3 02 00 
C2230300 
C2 230400 
C2230500 
C2330600 
C2330700 
C2237800 
C2 23 090 0 
C223 100C 
C2231 100 
C 233 1200 
C223I 300 
C2231 400 
C 233 I 500 
C2231600 
C223I 700 
C223180C 
C223 I 900 
C2232000 
C2 332 1 00 
C2232200 
C2332300 
C2332400 


A-140 


PRINT 22t. (EPl I ) .1 = 1 .2> .(EPD( I .K) .1-1 .3) C2332S0C 

PRINT 22t. K . ( FUD ( 1 ) . I = 1 .31 C2332600 

PRINT 229. ( (Eli I • J ) iJ = l .2) . ( l£ I D ( I , J ) . J = 1 • 3 ) . 1 = 1,3) C2232700 

PRINT 2JC. C FL IRC ( l . K ) . I = 1 , 3 ) , (FLCRCI I . K ) . 1 = 1 , 3 ) C2332800 

PRINT 23 1 . (DhKI I . K I . 1 = 1 . 31 C2332900 

33 CONTINUE * C2 333000 

. PRINT 213 C2 333 100 

4C CONTINUE C2333200 

CC 9 I=1,NFEK J . C 2333300 

9 PRINT 22C. t I . THAT I ) . I .TFADI I) . I .THAUOl I ) .1 . <OFC( J. I ) . J = 1 .3 ) ) C2333400 

N1 = NFEP+1. > • • - 1 1 1 ‘ C2333500 

N2 = NFEPfMN C2333600 



IF (MN .EO .0 ) 

RETURN 


. C2 333 700 


CG 1 2 I 

= M #N2 


C2233800 

- 1 2 

PRINT 2 

2 £ • 

I . Thai l ) . I .THAO < I) . I .THACOl I > 


C 2 3 3 390 0 

20 FORM AT 

(• CENTER OF MASS -••3DlA,8,/> 


C 2334000 

2 Cl 

FORMAT 

( / * JX 

» • HBOC Y = • , 3 D l A • d ) • ' **- . 

< ‘ l ■ : 

C2234100 

20 2 

FORMAT 

( 3X. • 

H INERT = « •3DI7.6) • ' • 

' * ‘ . . 

C 2 3 3420 0 

2 C 2 

FORMAT 

< •! T I ME = • .DIS.S./ ) - 


C23343C0 

20 A 

FORMAT ( / , JX, 

•BODY . • , I 2 .4 X . • PCMC = • . JDl 7 .d . JX. • FCMC = 

1 .3017.8 ) 

C233440C 

2 0 £ 

FOPMAT 

( 14X. 

•CAC = • ,30 1 7 .8 .3X . *Ct=C = *.3017.6) 


C2334S00 

2ce 

Format 

( 14X. 

•XMC = * . JC 17.8 ,JX. *XIC = *.3017.6) . 


C 2 33460 0 

20? 

format 

( 14X . 

•ACC = • .30 l 7 .8 ) 


C233470C 

2ce 

FORMAT 

( / . 3X 

, 'ORIGIN • ,4X . 'FEMC ■= * . 3017.6. 3X, *ACl = 

• ,3017.8) 

C233480C 

20"; 

FORM A T 

(• ANGULAR MOMENTUM .* # .O20,8) 


C2334900 

2 1 C 

FORMAT 

( 3X , • 

HMCM ( * . I 2 . * ) = • .017.6. 10X. *CLM( *, 12 ,* ) 

= * ,017 .8 > 

C233500C 

2'1 1 

FURM AT 

( 2£X. 

JDl 7. 8) 


C23J5109 

2 1 2 

FORMAT 

(• SYSTEM INERTIA TENSOR s* ,J017,d) 

/ ; 

C 2 335 20 C 

2 1 2 

FORMAT 

i • • 

) 


C 2335300 

2 1 4 

FORMAT ( 14X . • 

HB = • , JO 17 ;a, 3X. • TK = *.017.6) 


C233S4C0 

2 1 5 

FORMA T 

( /. • 

KINETIC ENERGY = *,D20.d> 


C 2 3 35500 

2 i e 

FORM AT 

( 14 X , 

•PCS - * . 30 1 7 .e .3X , • VEL = *.3017.6) 


C2335600 

21 7 

format 

(/. • 

LINEAP MOMENTUM = *.01*0.6) 


C233570C 

2 i e 

FORM A T 

i 14X. 

• LN = *.3017.8) 


C 2 33 580 0 

2 l S 

FORMAT 

( / . JX 

.•LdOCY = *.3017.6) 


A/ C233590C 

2 2 C 

FORM AT 

( 3x . • 

THAI*. 12.*) =*.C1J.U.JX,* THADl * . 12. • ) = ■ 

*D 1 2 .6, 2X,' 

THAC2336000 


* I'D ( • • 12 

. * > = 

• ,01 J .fc. 3X . • CPC 1 * . 12,') =• . JO 13. 6) 


C2 236100 

22 1 

FORMAT 

( 1 4 X t 

•XMC = * .30 17.8 ) 


C 233620 0 

222 

FORMAT 

( ’ 

TOTAL SYSTEM PASS =*,017.0./) 


C2236300 

222 

FORMAT 

( 14X, 

•ETC = • .3D 17.6 .3X , 'PHI = *,JD17.d) 


C233640C 

2 2 4 

FORMAT 

< 14X, 

•C3C = • .JC 17.8 ) 


C 2 336 50 C 

225 

FORMAT 

( 3X . • 

THAI*. 12,*) = • ,C 1 J .6 , JX . • TPAOl * . 12 , • ) =• 

• D1 3 .6, 3X .• 

ThA C2336600 


* CD ( • ,12 

. * ) = 

• » 01 3 • c ) 


C2336700 

2 2t 

FORMAT 

( / . 3X 

. * FLEX IBLE * .3X . • EP = * . 30 1 7 . 6 . JX . • EPP = 

•,3017.8) 

C223680C 

2 2 t 

FORMA T 

t 3X . • 

BODY * . I2.4X .* CO = *.3017.6) 


C2236900 

22R 

FORMAT 

( 14 X * 

• El = * . 30 1 7 .8 ,3X , *CIO = ' • JO 1 7 • 6 ) 


C2 33 7000 

2 3 C 

FORMAT 

( 14X, 

•FIR = • , 3C 1 7 . 8 .3X . • FCk = *,JDl7.o> 


C 2337100 

23 1 

FORMA T 

1 14X, 

•OHM = • ,3C 1 7 .8 ) 


C233 7200 


RETURN 




C2337300 


ENC 




C2337400 

* { V 

< ■ ■> 


- ‘ ‘ * .* .i-s. . r t , i‘> , i 4 

• i • ' M 



- ; j 


1 03=*. J w = 7 

i t) )~i IOC* 3 :• V 

.1 1 '* * 


SUER CUT I NE S IMOl C .C ,N , NC ) 

IMPLICIT REAL*t)( A-H ,0-Z . * ) 

LOGICAL LcOU 

LOGICAL LRLNGE . LTPNSI . LVDIV . LEUUIV . L TP AN 


C2 409000 
C2403I 00 
C2400200 
C24C0300 
C 24 0040 0 
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L1FANV 

LGFDCT 


IRATE 
LDC T 


LXDY 

LANGLE 


LET A 

LSE tup 


L TGR QU 
LSIMQ 


C l NE N S l C N 0( 1 ) ,C ( 1 ) 

C I MENS I CN DO < 33 1 32 ) ,CC( 33) 
L S ED TJ COTAIN SOLUTION CF 

c*x = c 


A SET OF SIMULTANEOUS LINEAR ECU AT IONS 


DESCRIPTION OF PARAMETERS 

C = COEFFICIENT MATRIX STORED CULUMN-*IS£ DESTROYED 
CCMPUTATICN 

N = NUMBER CF ECLAT I C NS 

NC = DIMENSION CF ARRAYS D AND C IN THE CALLING SUGROLTINF. 
C - VECTOR OF ORIGINAL CONSTANTS OF LENGTH N, THESE ARE 
REPLACED 0Y THE SULUTICN VECTUA 

COMMCN /LDEUUG/ LRUNGE • LTRNSI • LVDIV • LEUUIV » LTRAN 

- '' LTRANV • LRATE • LXDY ♦ LET A , LTOROU . 

* LCFDGT , LCCT , LANGLE • LSETUP . LSIMC 

'ECU VALtNCc (LSIMC.LFOU) 

IF < L E CU ) PR I NT 1 C 7 


FROM CIMENS1CN 
ARRAY 


1 A 


. TAKE ARRAY D 
TC AN NXN 
IJ = 0 

CO 14 J = 1 .N 
1 J3 = < J - 1 ) *NC 

co i e i= i ♦ n 

ij = u ♦ i 

C(‘IJ I = C< IH J3 ) 

I p (LEO l ) CD ( I » J ) - D ( I J ) 

CC NT INUE 
IF (LECu) 

CONT INUE 


NDXND AS OEFINEC In CALLING 


CC( J) = C(J) 


F O R W / Si) EOLUTiCN 


C 2 A 0 0 50 0 
C2A0060C* 
C2AC0700 
C2 400800 

C2Accyco 

C24C1 000 
C 2 40 1 TOO 
C 240 1200 
C2401 300 
DLk ING C240 1 4C0 
C2401 500 
C24016CC 
C2401 7C0 

c 2 40 1 eco 

C2401 900 
C2402000 
C 2 402 1 00 
r C 2402200 
C24023C0 
C240240C 
C 24 02 50 0 
C240260C 
SUeRULT INE C24C2 70C 
C2 40 2 HOC 
C 2 4 0 2 9 C 0 
C240300C 
C2403I 00 
C240320C 
’ C 2403 700 

C2 4 0340 0 
C2403S0C 
C 2 4 0 3 fc C 0 
C2403700 
C2 403600 
C2 403900 
C240400C 
C2404 1 CC 



' ' ' 

TOL = 0.C0 


02404200 


.»• 

•K S :•= J 


C240430C 



r JJ- = -iM 


C24C4400 



ca' 6; ‘j = i.n 


C24 04500 



■JY- = J + 1 


C240460 0 



JJ = 


C2404 700 



EICA = C.PO 


C2 40480C 



IT = JJ-J 


C24C4900 



CO 22 I=J.N 


C240500C 

c 




C2 405 1 00 

C 


SEARCH FCft MAXIMUM CCEFFICIEM IN COLUMN 


C24C5200 

c 




C 2 4 053 CO 



I J = l T+ l 


C24054C0 



IF (OAbiil E1UA ) - CAES(C(1J))J <il.3J.3J 


C2405500 


2 1 

EICA = C I I J> 


C24056C0 


/ ' * 

I MAX = I 

r. r\ . «■> 

' C2^05700 


' ? 2 

CON-T INUfc 


C24O50CC 

c 


i •- 


02415900 

C ' 

*?•' \ 

TEST FCF PIVUT LESS THAN TOLERANCE 

( i • » ) - 5 T e: :• i 

C2406CCC 

c 




C 2 406 100 



IF (0AE3( EISA » - T CL ) 3E.S5.AC 


C2406200 


3t 

KS = l 


C 2 4 06 3 0 C 



FRIN1 ICJ 


C2 406400 
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\ ET CP 

FETUFN 

c 

c IMEfCri/INGE HOWS IF NECESSARY 

4 C II = J ♦ N*< J -2 ) 

IT = IMA* - J 
CO SC K — J ■ N 
I I * I 1 ♦ N 

12 = II 1 IT 
SAVE = C(I 1 ) 

Cl 1 1 I = C< 12 > 

Cl 12 ) = SAVE 

CIVICE ECUATIUN d Y leading coefficient 

SC Ct II ) = C( II )/BIGA 
SAVE = C( IMAXI 
C < IMAX ) = C( J ) 

C( J ) = SAVE/BI GA 

ELIMINATE next VARIABLE 

1 FIJ-N) S 5 . 7 C .55 

5 E 10 £ = N*( J-l ) 

CO 6 E IX=JY.N 
IX J = I OS + IX 
IT = J - IX 
CO 6 C J* = JY.N 
IXJX = N 4 IJX- 1 ) ♦ IX 
JJ* = IXJX ♦ IT 

6 C Cl ixjx) = D( ixjx) -<n< ixj)*c( jjx) ) 
es ciix) - ciix) - < c ( j) *c < ixj ) ) 

BACK SOLUTION 

7 C NY = N-l 
IT = N*N 
CO 8 C J = 1 ,NY 
IA = IT - J 
IB = N - J 
IC = N 

CO 8 C K= 1 ,J 

C ( IB ) = C ( I B ) - C<IA)*C(IC) 

IA = IA-N 

8 C IC = IC -1 


IFI.NOT. LEQU) GO TO 1C0C 

TEST1 = C.OO ... 

. CO l 1= 1 iN 
TEST* = C.OO 
CO 2 J=1.N 

2 TEST2 = TEST 2 «• OC(I.J)*C(J) 

• c ST2 = IEST2 - cell) , » *) 1 )•« ; 

FR INT ICE. I .TEST2 
IEST1 = TEST l ♦ TEST2**2 
1 CONTINUE 

TEST1 = CSQRT(TESTI) 

FRINT ICS. TEST1 


02406500 
C 2 406600 
C 2406700 
C 2406800 
C 2 406900 
C 2 40 7000 
C 2 40 7 1 00 
C 2 40 72 00 
C 2 40 7 300 
C 24 C 7400 
C 2 40 7 500 
C 2 40 76 00 
C 2 407700 
C 2407800 
02407900 
. . C 240 BCO 0 
C 2 40,8 IOC 
C 24 C 62 C 0 
C 24 C 8300 
C 24084 CO 
C 24 T 8 SOO 
C 24 C 8600 
02408700 
C 2 40880 C 
C 24 T 8900 
C 2409000 
C 2 40 9100 
C 2 409200 
C 24993 CC 
C 24 0940 0 
C 240 S 500 
C 2409600 
C 2 409 700 
C 2409800 
J.C 2409900 
C 2410000 
C 2410100 
. C 24 1 0200 
C 24 I 0300 
C 241 C 400 
C 241 0500 
C 2 4 1 060 C 
C 24 l 0 70 0 
C 2410 e 0 C 
C 241090 C 
C 24 1 l COO 
C 24 I l 100 
C 2 4 1 1200 
C 241 1 30 C 
C 24 1 1 400 
C 241 1 500 
C 2 4 1 l 600 
C 2 4 1 1 700 
C 24 1 1 800 
, C 24 TI 900 

C 241 2000 
C 241 2 100 
C 24 1 2 200 
C 241230 C 
C 24124 C 0 
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100C continue 


c 


ICC FORMAT 

103 FORMAT 

104 FORMAT 

105 FORMAT 

1 06 FORMAT 
1 C 7 FORMAT 
1C a FORM FT 
109 FORMAT 

RETURN 

£NC 


( 6015. S) 

I* MATRIX IS SINGULAR GARBAGE FOLLOWS •) 
I* 0( 1 * 14 i 1 1 = XMNI * . I 2, • , • , 12 . • ) = '.020 
IV •> 

I • CC • .12.*) = • ,020.10) 

CM SUBROUTINE SING ENTERED •) 

(• ERROR IN ROW * . 12 . * = *,017.6) 

(' NORM OF ERROR VECTOR = *. 017.6) 


10 ) 


C24! 2500 
C24I 2600 
C2412700 
C 24 1 280 0 
C24I 2900 
C241 3000 
C241 3100 
C241 3200 
C241 3300 
C2413400 
C 241 3500 
C241 3600 


C 


c 

c 

c 

c 

c 

c 

c 

c 

c 


Suefi CUTINE RUNGEI T .H . Y , YC . N1 .N2 . TEM ) 
IMPLICIT REAL*8( A-H.0-Z.il 
LOGICAL LEOU 


LOGICAL 

erunge 

• 

LTRNSI 

» 

L VDI V 

• 

LtOU I V 

• 

LTR AN 

• 

* 

LTP ANV 

« 

lrate 

t 

*_XOY 

• 

LETA 

« 

LTGfc OU 

• 

♦ 

LQFDCT 

• 

LDCT 

t 

LA NOLL 

• 

L St TUP 

• 

LSI MO 


CO**«CN /L0E6UG/ 

LRLNGE 

» 

LTRNS I 


LVOI V 

» 

LEQJ IV 

• 

LTR AN 

• 

* 

L TRANV 

t 

LRATE 

• 

LXOY 

• 

LET A 

• 

L T OR QU 

t 

* 

LCFOOT 

t 

LOCT 

• 

LANoLC 

• 

LSETUP 

• 

LSI MO 



EQUIVALENCE ( LRUNGE . LE CU ) 

CINENSICN YI I ) ,YC <1 > .TEN (2 . 1 ) 

ACCEPTS SYSTEM STATE AT TIME T 
RETURNS SYSTEM STATE AT TIME TaH 
SYSTEM STATE YIN) 

CER I VAT I VE OF YIN) IS YD IN ) 

SUBROUTINE OYN COMPUTES YCCN) AS REUUIAEO BY RUNGE KUTT t A 
NUMBER UF STATE VARIABLES IS HI ♦ N2 
M = NUMEER OF DYNAMIC ECUATIJNS 
N2 = NUMBER OF EQUATIONS FRCM TORQUE 

TEMPORARY STORAGE AREA TEM(2.N) not to be USED in DYN 
N 3 Nl A N2 
IF ILEQU1FRINT 202 

IF CLECU )FRINT 200. I I , Y I I ) . I . YD I l ) , I , TEMI 1 . I ) . I , TEM I 2 . 1 ) . I = 1 .N ) 
K s C 

CO 1 I=1.N 

TEMCl.I) = YII) 

1 TEM( 2 . I ) = YOl I ) 

CO = P/2 

A = CO 

2 T = T A CD 

3 CO 4 1=1. N 

4 YII) = TEMI 1 .1 JAAAYDI I > , 

- i- IF ILEQU) PRINT' 20 1V •< I'. VI I ) . I . YO I I ) .T'.TEMI 1 . I ) , I .TEMI 2. I). I = 1.N ) 
CALL OYN I Y .YD.N1 ) 

IF <L E JU )PR INT 200 . (I . Y 1 1 )., I . YO 1 1 ) .1 .TEMI 1 . I ) . I. TE M I 2 . I ) . I = 1. .N ) 
K = K*1 . 

IF (K.EQ.2) GC TO 7 
CO 5 1=1. N 

£ TENI2.I) = T EM (2,1) A 2*YC(I) 

IF (K .EQ . 1 ) GO TO 3 

Asp 

CO TC 2 


C2SC0CCC 
C2S001C0 
C 2 5002 00 
C2SC030C 
C2500400 
C25005C0 
C2SOC600 
C2SC07CC 
C2500800 
C2500900 
C2S01 000 
C2S01 I 00 
C25C12C0 
C2S0I 300 
C2S01 400 
C2S01 500 
C2501600 
C2501 700 
C250I8C0 
C 250 1900 
C2 502 0 CC 
C25021 CO 
C2S02200 
C250230C 
C 2 50240 0 
C2E725C0 
C2E02600 
C25027C0 
C2 50280C 
C2 5 02 SCO 
C25C300C 
C 2 SO 3 1 00 
C 250320C 
IC2503300- 
C2 503400 
C2503500 
C 2 50 3 600 
C2S03700 
C 2 503800 
C2 503900 
C25040CO 
C2S04 | 00 
C2504200 
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7 A = A/6 

co e i — 1 , n 

TENC2.1) = A*CTEMC2.t) ♦ YOCll) 
e YC It = TEMC1.I1 TEMC2.1) 

IF (LEGO )FR INT 201 . ( I , Y ( 1 } . I . YD ( I } . I ,TEM( I . 1 ) , I . TEMC 2 , 1 1 . I = l ,N ) 
CALC OYNCY.YO. Nil 

IF <C E Ju 1RR1NT 20 0 . C 1 . YC 1 ) ,1 . YD ( I ) .1 .TEMC 1 .1 ) , I .TEM12. t) .1 = 1 ,N ) 
20C FORMAT (• IN RUNCE YC • . 12 . • ) = *.018.8.* YCC*.I2.*1 = *.018.6. • 

• EMC 1 . • , 12, • I = *.018.6.* TEMC2. • .12. • > = *.018.8) 

2C 1 FORMAT C* OUT RUNCE Y('.12.*l = *,018.8.* YCC*,I2,*) = *.018.6.* 

• EMC 1 . * . 12, • ) = *.018.8,* TEMC2 . * . 12. • ) = *.018.8) 

202 FORMAT 1*1*1 

RETURN 
ENC . 


C2S0430C 
C2S04400 
C2E04500 
C2E046CO 
C25C4 7.CG 
C2S04800 
C2SC4900 
T C 2 £0500 C 
C2505 100 
T C2S052CC 
C2S05300 
C2E05400 
C2E055CC 
C2E0560C 


C 


c 

c 


SUERCCT INE UNCAGE ( SCG. SC .T . TUG 1 
IMPLICIT KEAL*e( A-F.0-2 . 1 1 
INTECGk SCG. SC ( 1 ) .SCG1 ' 

CIMENSICN TUGCl) 

TEST TC SEE IF TIFF TC LNC AGE ANY DEGREE CF FREEDOM 
IF YES DO SO AND RENLMEEK SC ARRAY 
SCC1 = SCG 
CO 6 1=1. SCG 1 

IF CT .LT . TuGC SC C I 1 ) 1 GU TC 6 
SCG = SCO-1 

Ffi IN T IOC , SCI 1 ) . T . SCG 
SC C I > = c 
e ccntinlc 

IF CSCG .EC.SCGl ) RETURN 
J = C 

CC 7 I - 1 . SCG 1 
IF CSCC 1 ) .Ell. Cl GO TO 7 
J=J+1 

SC CJ )=SC Cl) ’ . ' 

IF ( I .Eg . J 1 UC TO ) 

SC ( I ) = c 
7 CONT INUc 

IOC FORMAT (• MOTION ABOUT FREE VECTOR *.I2.' UNCAGED AT T 
«• MOT I C N STILL CACEC AECLT * . 1 2 , • FREE VECTORS •) 

RETURN 

ENC 


C260000C 
C2600100 
C 260020 0 
C26003C0 
C 2 1 0040 0 
C260C50C 
C2600600 
C260C700 
C 26 3 C80C 
C2600900 
C2601.000 
C260110C 
C2601200 
C2601300 
1 C2C01400 
C260 1 500 
. C2 601600 
C2601700 
< 'C260I800 

C260I900 
C2602000 
C260210C 
C2602200 
=• .C 15.5. C2602300 
C2602400 
C26C2500 
C2602600 


SUER CUT 1NE .COMPR S (XMN.THACD.N.SC.SCG.LGl 



C2602 700 

IMFL I C.I T HEAL*8( A-F.O-Z . 1 1 

.« , 

\ t, <-~ ?» ^ * 

>. T>;r. C260280.0 

C I ME NS ION .XMNC'33 . 1 ) . THACC C 1 > A ‘ ' 



C2602900 

INTEGER SC C.I') . SCG 



C26030C0 

LOGI CAL .LGC,T>) 



C260310C 

SC T LP LCGTC flags 



C 2603200 

NS = N * SCG 



C2603300 

CO 7 l = l,N3 



C2603400 

7 LG ( I ) = . TRUE,. 



C26035CC 
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co e 1=1 .sco 

6 CG(SC( I ) ) = .FALSE. 

• 11 = 0 

CO 9 1=1 .NS 

IF< .NQT.LGd I ) GO TO 9 
, . 1 1- = 

TM AOC ill) = ThADD ( I i 
JJ = C 

CO 1C J = 1 . NS 

IF < .NOT .LG< J 1 > GO TO 1C 

JJ = JJ+1 

XMNl II.JJ1 = XMN( t.Jl 
1 C CCNT INUE 
<; CONTINUE 
RETURN 
. ' 6NO 


C2603600 
C2603700 
C2603800 
C2603900 
C2604000 
C2604100 
C2604200 
C2604300 
C2604400 
C260450C 
C2604600 
C2604700 
C2C04800 
C 2 604 900 
C2605000 
C26051 00 


. SUERCUT.INc UNPRS ( ThAOO.N .SCG.LG) 
IMPLICIT REALA.8C A-H.O-Z.1I,... - 

CIMENSICN THADC(l) 

INTECER SCG 
LOGICAL LG ( 1 ) 

' . 12 = N 

NN = N-f SCG 
CO - 1 1 1= 1 ,NN 

II = NNA1-I 
lFILCII 1 11 GO TO 12 
THAOCt 111= C. 0 
CO TC 1 1 

12 THACC(Il) = THADD ( 12 ) 

. 12 = 12-1 
11 CONTINUE 
.FETUFN 
ENC 


C2605200 
C2605300 
C2605400 
’C2605500 
C26056C0 
C260570C 
C2605800 
C2e05900 
C2 6060 00 
C2606 100 
C 2606200 
C 2 606 300 
C2606400 
C260650C 
*C 2 60 660 0 
C26067C0 
C2606800 


C 

c 

c 

c 

c 


SUER CUT I Nc CCMPAC ISET.NSET .SI 


IMFL ICI T 
IN TEC-ER 
CATA A/ 


008 




K EAL * 8 < A-H.O-Z. 1 1 
SET(NSET) .A (24) ,S.A8 


A Ab/ 


Z 1 

Z10 

Z 100 

Z 1000 

Z10000 

Z100000 

ZIOOOOOO/ 


Z2 

Z2C 

Z2C0 

Z200C 

Z2C0CC 

Z2CCCC0 


Z 4 

Z40 

Z400 

Z4000 

Z40000 

Z400000 


. z a . 

. Z80 

. ze'oo ' ' 1 ’ . 

. zuooo • ! . 

. Z 8 00 0 0 i 

. Z 8000 00/ • 



S\4I-L>*!. - i , > + I j 


TAKES THE SET CF INTEGERS STORED IN SET(NSET) ANC COMPACTS 
THEN l.MTC THE SINGLE CODEC INTEGER KURD S. THE SET OF 
INTEGERS IN ARRAY SET MOST EE DISTINCT FRCM EACH CT HE R 
ANC LIE EETxEEN I AND 24 INCLUSIVE. 

£= NSET * Ato 
IFINSET.EU.01GO TO 2 


C26C69C0 
C2607000 
C2607100 
C 2607200 
C 2 607 300 
C26C7400 
02607500 
'C26C760C 
C2607700 
•C2607800 
C2607900 
C2608C0C 
C26C8I 00 
C 2608200 
C26 58300 
C26C8400 
C26C8S00 
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.CO 1 K=1.NS£T C26C8600 

1 S= S ♦ MSETIKlI C2CC6-700 

FETUFN C2608800 

£ET(|I = C ' C2608900 

.PE TUFN 1 C2609000 

c NC C2 6091 00 


SUERCL T I NE U NP AC (SET iNSEIiSi 


IMFL IC I T 

Fc£AL*d< A-F 

•t 

N 

■ 

o 

• 




IN1ECEA 

SET ( 1 ) . A I 24 ) . E . AB , T S 

/• 



C A 1 A A/ 

L 1 • 

Z 2 . 

24 

• 

Zb 

* 

210 

Z20 . 

240 

• 

Z 80 

* 

Z10C . 

Z200 . 

Z400 

» 

ZBOO 

* 

21000 . 

Z2C0G . 

24000 

» 

zaooo 

A 

210000 . 

Z200C0 . 

240000 

• 

zaooco 

* 

2100000 . 

Z2 00 COO . 

Z400000 

9 

2800000/ 

DATA 46/ 

21000000/ 






C C6CQCES THE CODED »OfiO S TO 03TA1N THE ELEMENTS OF SET C NSET ) 

C ELEMENTS OF SET RETUPNEC IN CECKEASING ORDER OF MAGNITUDE 

C , SET I 1 ) .GT . SET! 21 .GT GT . SETINSET) 

NSET = E/Ad 

IF INSET .EQ.O ) GO TO 5 

1 = C 

• TS= £-NSET*AE 
KN = 2E 

CO . 1 K= 1 ,24 

IF I TS-AIKN-K) > 1.3.2 

. 2 . 1= 1,4 1 

EE T I | ) = KN-K 

IS = TS-AIKN-K) 

1 CONTINUE 

2 1=14 1 

SEU I ) = KN-K 
4 RETURN 
E SET< 1 ) = 0 
RETURN 
ENC 


C2609200 
C 260 93 0 C 
C2609400 
C2609500 
C2C09600 
C 2 609 700 
C2E09800 
C2609900 
C26IOOOO 
C 261 0100 
: ' C261 0200 
C261 0300 
C2610400 
C 2 6 1 C500 
C2E1C600 
C261C700 
C261C800 
C 2C 1 0900 
C26 1 1000 
C2611100 
C261 1 200 
C2CI 1300 
' C26 1 1400 
C261 l 500 
C 261 1600 
C26 1 1 70C 
C261 1 800 
C2E1 1900 
02612000 
C2612100 
C 261 2200 


INT6CEH FUNCTION KTOIK.w.KI 
IMPLICIT REAL*e< A-t- .0-2. J » 

•... \ ifik.ge.j) gc to i 

KTC=KMN-1 >4j4l-K*(K-l .1/2 
GO TC 2 

.'1 r .KT C = J»(N-1 > + K ♦ 1 - 
2 FETUPN 
ENC 




C261 2300 
C2612400 
C2612S00 
C261 2600 
C26I2700 
t' 26 l 2800 ^ 
C261 2900 
C261 3000 
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J* I J-l )/2 



non 


INTEGER FUNCTION KT1IN.J.K) 

IMRLICIT ReAL*8I A-E,0-2, S >. 

IF I K iGe . J> (jC TO .1 

KT 1= (K- I )*(N-l l+J-IK-l )* IK-2 )/2 

00 T C 2 

1 KT1 = IJ-l)*lN-i)' +' K - I J- 1 ) * I J-2) /2 
£ RETURN 
END 


C261 3100 
C 26 13200 
C2613300 
C261 3400 
C26135C0 
C261 3600 
0261 3700 
C261 3eoo 





LOGICAL FUNCTION CTAINII.S.N) 


C2C13900 



IMFLICIT REAL* 81 A-F.O-2, I ) 


C2614000 



INTEGER SIN) 


C2EI4100 

c 




C £614200 

C 


CTAIN = .TRUE. IF EOCY LAoEL 

I CCNTAINEC IN SET SIN) 

C 26 14 300 

C 


= .FALSE. IF NO I 


C 26 1 4400 

c 


ELEMENTS IN SETIN) MIST St FC S I T I VE NON- ZEH'c" I NT EG ERS IN 

' C2ET4500 

c 


EITHER ASCENDING OR CECENDING 

URDER JF MAGNITUDE 

C261 4600 

C 




C261 4700 



IF IN .EO.C.CR . I .EQ .0) GC TC 1 


C261 4800 



M = N+l 


C261 4900 



IFIS IN > - SIl)) 2.2.3 

* 

C2615000 


2 

K = N 


C261 5100 



L - -1 


C £6 1 5 200 



GO TC 4 , 


C261 5300 


■3 

K = l f . 


C261 5400 



L = 1 


C 26 t 5500 


4 

IFISIK)-!) 5.6.1 


C2615600 


c 

K 5 rf-f L 


C2615700 



IF IK .EO .C.OR.K .ED .N1 ) GC TO 1 


C£ 6 1 5800 



GO TC 4 


02615900 


1 

CTAIN = .FALSE. 


C2616000 



RETURN 


C2616100 


t 

CTAIN = .TRUE. 


C £61 6200 



RETURN 

■ f 

02616300 



END 


C 26 1 6 400 


SUERCUTINE VECTRN IVA.XMT.VAC) 

C PERFORMS TRANSFORMATION CF COORDINATES FOR VECTORS 

C XMT - MATRIX. TRANSFORMS VECTORS TO COMPUTING FRAME COCRCINATES 

c „ V , FROM 000 V LAM6A F I XE 0 ( COOR C I N AT 

C*. VA = VECTOR INFLTED RELATIVE TO BODY LAMBA FIXED COORC I N A TE S .. 

C VAD = VECTOR CCMPCNEMTS COMPUTED RELATIVE TO COMPUTING FRAME 

C 

C03E0V EQLA T ICN SOLVED IS A ^ , 

VAD = (XMT» * VA 

IMPLICIT REAL*8I A-E.C-Z.S) 

DIMENSION VA (3 ) .XMTI 3,3 ) .VACI J) 

CO 1 1=1.3 

VACI I ) = C 


C2 700000 
C2 700 1 00 
C 2 700200 
C2 700 300 
C2 700400 
C 2 700500 
C2 700600 
C2 700700 
C27CC800 
C27C0900 
C2701000 
C2701 100 
C 2 70 1200 
C 2 70 1300 
C2701400 
C27C1500 
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. CO I J= 1 .3 

1 VAC( I ) = VADI I ) *XMT ( I . J ) * V A( J I 
RETURN 
ENC 


C2701600 
C2701 700 
C2701800 
C2 70 1 900 


SUERCOT INE TENTRN I XI , XXT ,X IC ) 
c TRANSFORM 3 X 3 TENSCRS XI 1 H CHECK FOR SYMMETRY 

v -• IMPL ICIT'REAL*a< A-h.G-Z.tl • ■ • - ■ - - 

CIXENSICN XI < 3 , 2 ) .XMTI 3 . 2 ) .XIDI 3 . 3 ) 

LOGICAL FLAG 
FLAG = .TRUE. 

Ip" ( XI ( 1 , 2 ) .EC. XI I 2 . I ) 

* .AND. XI U , 3 > .EQ.XI ( 2 . 1 ) 

' * - . AND .XI ( 2 . 2 ) .EO.X I < 3 . 2 ) ) GO TO. 2 

J . FLAG s .FALSE. . . . . 

2 CO 1 1 * 1.3 
' II = I 

IF(FLAG) GO TO 3 
11 = 1 

2 CO 1 J= I 1 . 3 
X I 0 I I . J ) = 0 
CO I L = 1 • 3 
CO 1 M= 1 . 3 

XICII.J) = XIC(I.J) ♦ XX T( I ,L) *XI (L . M) *XMT ( J .M ) 

.1 cgnt inue 

IF ( .NGT .FLAG ) RETURN 
XICI 2 . 1 ) = XID < 1 . 2 ) 

XICI 2 .I ) = XIOI 1 . 2 ) 

XICI 2 .2 ) = X ID< 2 . 2 ) 

RETURN 
' ENC 


C 2 702000 
C27O2I0O 
C2 702200 
C2702300 
C2 702400 
C2 702500 
C2 702600 
C27C2700 
C2 702800 
C27C2900 
C2 703000 
C2703100 
C27C3200 
C2 703300 
C 2 70340 0 
C 2703500 
C2 703600 
C2 7037C0 
C2 703800 
C2 703900 
C2 704000 
C2 704 100 
C 2 704200 
* C27C4300 
C2 704400 
C 2 704500 


l OC 


SUERCU 
IMFL IC 
CIXEFS 
U EE C 
A = V ( 
IF ( A .N 
FR INT 
FORMA r 
♦ EAEL.Y 
; RETURN 
‘ . A-' = C S 
CO 2 

. > ;« i > = 

RETURN 

ENC 


TINE VECNRM (V) 

IT REAL»8I A-H.O-Z , J ) 

ILN VI 3) 

TC NORMALIZE VECTORS TO UNITY 

1 ) * * 2 ♦ 'vI2M*2 ♦ VI 3)4*2 

E.C) GO TO 1 

ICC. • 

(• GIM8AL LOCK CONDITION. NORMALIZATION SKIPPED ERRORS FRO 
FOLLOW • ) 

;<iL>U.i I "4 A»i4* ' i.'ii W l r l ,r 


GRTI A) 

1 = 1.3 
VII ) / A 


2 1 03V j02 ,1311 A I 


C2 704600 
C2704700 
C 2 704800 
C 2 7 C 49 00 
C 2 705000 
C2705IOO 
C 2 705200 
C27C5300 
C2 705400 
C 2 705500 
C 2 7C5600 
C2 705700 
'C 2 705800 
C27C5900 
C2 706000 
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ct n 


■ ELERCUTINE MATMUL lA.d.C.N) 

■ : iMFL IC I T R E AL * E I A - F , O- Z , S > 

' CIAEhSICN A(NiN) .EINtKJ.CINiN) 

CCMPLTS THE STANDARD MATRIX PRODUCT OF T*U NXN MATRICES 
* i •• ' A* 8 = C *■ 

'CO 1 I = ».N 
■ CO 1 J = 1 » N 
C I I • J ) = c 
-• CO 2 L = 1.N 

a.C(I«J) = C(l.J) F At I .L > *d!L. J > 

1 CO N T INUE 
SE TURN 
ENC 


C2706100 
C 2 7 06 200 
C27C6300 
C 2 TOE A 00 
C2 7 06500 
C2TC6600 
C2706700 
C27068C0 
C27C6900 
C270700C 
C2707 IOC 
C 2707200 
C270730C 


SUERCUTINE TRNSPS IXMT) 

G"- CSED TO COMPUTE THE TRANSPOSE OF A 
■•■•IMPLICIT «EAL*8I A -F ,0-2 . 1 ) 

■' CIM&FSICN XM T< 3 . 3 I . TEMP < 3 .3 ) 

■ CO 1 1= 1 .3 

•'■ f CO 1 J = I .3 

1 TEMPI I . J ) = XM T I I . J) 

CO 2 1=1,3 

CO 2 J= 1 ,3 

a XM TI I . J I = TEMPI J . I ) 

PE TURN 
ENC 


1 .C27C7A0C 

3X3 MATRIX C2707500 

. C2 707600 
C 2707 700 
C2707800 
C27C790C 
C270B000 
C27COIOO 
C 2708200 
C27C6300 
C2708400 
C27C8500 


• ■ SUERCUT INE ftOT(A.C.JA.TME) 

-••'*’ •- l M P L I C I T REAL* 8 ( A -F.O-Z , T ) 
if ‘ CEREPAL EULER ANGLE ROTATION MATRIX 
CIMERSICN TMEI 3 . 3 ) .V < 3 ) . t>< 3 ) 

S = C/OAESIC) 

CO 2 A N = 1 , 3 
AIM = S 
2A VlN) = .COO 

J J A = IAEStJA) 

'■'* = AAJA/JJA 

' • ■ • ''»< JJ A ) = 1 . ODO 

TMEI1.1I = OSQRTI 1.00 - Viai**2 
'■■■'! ’ " 'tME I a • 2 ) = OSQRTI t. 00 - VIl)**2 
, ■ TMEI 2 . 2 ) = OSQRTI 1 .DC - Wl)**2 

O05fcO? , tStE« I *2 ) = -VI3) 

“ "■* - ~ TME I a . I J = VI 2 J 
TMEI 1.2) = V I 2 ) 

TMEI 2 . 1 ) = — V I 2 ) 

TMEI £ .3 » = -VII) 

TMEI 2. a ) = VI 1) 

PE TURN 
ENC 


- VI3)* *2 )*•!!) 

- VI3)**2)**I2) 

- ..V I 2 ) * *2 ) * * I 3 ) 


C27C8600 
C270e700 
C2708800 
C27C8900 
C2709000 
C2 709100 
C27C9200 
C 2 709 30 0 
C2 7C9400 
C2709500 
C27C9600 
C27997CO 
C2709800 
C 2 709 900 
C2 7 1 0000 
C2 71 01 00 
C 2 7 1 C200 
C271 0300 
C27I 0400 
C 2 71 C 500 
C 2 71 0600 
C 2 7 1 C 7 00 


A-150 


SUERCUTINE VECA 0 DIV 1 ,V 2 .S> 

ACCS VECTOR VI TO V 2 RESULT IN S 
IMPLICIT REAL*a< A-h, 0 -Z.l» : 

CIMENS 1 CN V 1 I 3 ).V 2 I 3 ), SI 3 ) 

6 ( 1 ) = V !( 1 ) ♦ V 2 ( 1 ) 

SI £ I = V 1 1 2 ) ♦ V2I2I 
SI 2) = V II 3) + V2 I3J 

RE TURN 
ENC 


C2600000 
C2eooioo 
C 280 0200 
C2e00300 
C2800400 
C2E00500 
C2e00600 
C2800700 
C2eooeoo 
C2e00900 


SUBROUTINE VECSU3IV1 .V2 .C) 
SUBTRACTS- VECTORS V1-V2=C 
IMPLICIT REAL*dI A-H.O-Z.S) 
CINENSICN V1I3) .V2I3) ,CI 2) 
Cl 1> = VII 1) - V2I1J 

Cl 2 ) = V 1 1 2) - V2I2) 

CIS) = V II 3) - V2 13 I 

RETURN 

ENC 


C260I00C 
C2G01 100 

C2e01200 

C2E01300 

02801400 

C280I500 

C2801600 

C2eOI 700 
..C2801800 


SUER C UT INE SCLVISC.V.P) 
SCALAR * VECTOR 
IMPLICIT REAL*8I A-F , 0-2 . * 1 
DIMENSION VI 3) , PI 3) 

Fill - SC*V< 1 ) 

P I 2 ) = SC* VI 2 ) 

FI3) = SC*VI3) 

RETURN 

ENC 


C2E01900 
C2802000 
C2e02l00 
C 2602200 
C2e02300 
C2E02400 
C 2802500 
C 2 802600 
C2802700 


SU8RCLTINE VECOOT I VI . V2 .C) 

VECTCR OCT PRODUCT 
IMPLICIT REAL*QI A -Ft 0-2 « S )■ 

CIXENSICN VU3I.V2I3) 

C = VltI)*V2tl) ♦ V 1 1 2 1 * V2 12) + VH3)*V2I3) 
■RE TURN 
ENC 


C2802800 
C2 602900 
C2803000 
C2803100 
C2e03200 
f • 7 C2603300 
C2803400 


/ v * 


SUBROUTINE VECROS IV1.V2.C) 

.VECTOR CROSS PRODUCT C - VI X V2 
IMPLICIT REAL*8I A-H.O-Z , S ) 

C I ME-NS RtN -V l I3),V2I3)tCIS) 

CI1) = V II 2 ) * V2I 3 ) — VI 13 )*V2(2) 


C2e03500 
C2e03600 
C2E03700 
C 2603800 
C2eC3900 


A-151 



C(2) = VK3) *V2(D- V1(1)*V2(J) 
C <3 ) = V 1( I) *V2(2 l- VI <2 )*V 2 ( I ) 

'RE-TURN ' ‘ •;•'*!*.'! :’••••:» -■ - 

ENC 


C2e04000 
0 2 804 ICO 
C2E04200 
C2804300 


SUER CUT INE.TRIPVP4V1 »V2*V) 

CCMFLTES STANCAHO VECTOR TRIPLE PRODUCT 

V = VIXIV1XV2) 

= V1«(V1.V2) - V2*(VI.V1I 


IMPLICIT REAL*d( A-I-.O-Z.*) 
CIMENSICN VI(])iV2(3).V(3l 
A = V I ( 1 )*V2(l ) .♦ V I ( 2 I * V2C 2) 
E - Vl(l)*Vt(l) ♦ VM2)*V1(2> 
VIII = Vl( l ) *A - V2I I I *8 
VI 2 ) .= V 1 1 2) *A - V2(2)«e 
VI 3 1 = V1(3)*A - V2(3)*B 
RETURN 
END 


V 1 1 3 I * V 2(3) 
VI (3)»VI (3) 


C2e04400 

C2e04500 

C2EC4600 

C2e04700 

C2e04800 

C2804900 

C2805000 

C2e05l00 

C2E05200 

C280S300 

C2e05400 

02805500 

C2605600 

C2e05700 

C2e05800 

C2805900 


SUER CL TIKE OYADDI Cl .02 ,D) 

ADCS THU DYADS 
’■ C = 01 + C2 

IMPLICIT «EAL*8( A-H.C-2.il 
CIVEESICK 01(3,3). 02(3.3). 0(3.3) 
CO 1 1=1,3 

CO 1 3=1,3 . 

C(I.J) = OI(I.J) -•« 021I.JI 

RETURN • . « ,'• > ‘ -C. ' . * \ ' 

ENC 


C2eC6000 
C28061 00 
C2806200 
C2e063C0 
02806400 
C2606500 
€2 8 066 00 
C2e06700 
C2806800 
C2eC6900 


SUERCUTIKE SCLC(A.C.T) 

• IMFLICIT «EAL*e( A-P. 0-2,1) 
CIREESICN 0(3,3) ,7(3.3) 

rtf mult iply scalar a> a tenscr 
••*•7(1,1) = A*0 (1,1) 

’ T ( 2 , 1 ) = A *D (2,1) 

T ( 3 , 1 ) = A *0 ( 3 « 1 ) 

T( I ,2 ) = A*D( 1 .2) 

112.2) = A4DC2.4) 

■ T( 2 ,2 ) = A*D (3,2) 

T(l, 3) = A*D(i, "3 ):,.-•'•• • 

. T( 2 ,3 ) ± A AD (2 .3) 

' V( 2 i 3 ) = ' A*D 1 3»3 ) 

RETURN 

• EN-C. - 


C2e07000 
C2807100 
C 280 7200 
C2e07300 
.02807400 
C2607500 
02 eC 7600 
C2e07700 
02e07800 
C28C7900 
02808000 
C2eoeioo 
C2e082p0 
C2e08300 
0 2 E C 84 0.0 



SL8RCUTINE DTOOTVCA.'v.b) *' ' 

: c; 1 ' SCALAR CCT PRODUCT OF OTAD AND VECTOR 
C D = A . V - 

IMPLICIT HEAL*8< A-P.O-Z.ll 
CIMERSICN OI 21 .At Ji3) . V12I 
CO 1 1=1.3 

Cl I) = C 
CO I 3=1*3 

1 Cl I) = C 1 1 1 ♦ All ,J)*Vt J | 

PE TURN 

• enc' ' ; _ •; 


ceeoesoo 

czeoaebo 

C2'e08 700 
C2 808800 
C2808900 
C 2 809 000 
C2eC9i00 
C2609200 
C2e09300 
C2609400 
C28C9500 


c 

SUERCUTINE VXDTOVlVl • D T • V ) ' ' » 

1 COMPLIES. VECTOR X 10TAC . VECTOR) « 

l l 


C2609600 
C2 809700 

c 

V = VI X ICT . VII 

- 

V 

. €2809800 


IMPLICIT REAL* 8 1 A-F »0— Z < 1 ) 


■ c 

C2E09900 


CIMENSICN V1(3),V2(3I.V<2I .DVI3.3) 



C2e 10000 


. CO 1 N= 1.3 



C2810100 


V2 I K ) = C.00 



C 281 0200 


CO 1 J=1.3 



C2810300 


. 1 V21KI = V21KJ ♦ 0 V(K . J J * VI l J » 

. VI I )= VI (2)*V213) - V 1 < 3 ) * V2 12 ) 
VIZ.) = V113)*V2(I) - Vlll)* V2 (3) 
VI 3 I * Vlll)*V2(2) - V 1 1 2 ) * V2( I ) 

- 


C2810400 
C 26 1 0 500 
C2E 10600 
C2ei07eo 


RETURN 


■ 

C 28 1 0800 


' ENC 

’ 1 


C28I0900 


.SUERCUTINE OVTOV* 10. XI , A) ’ •<: i- ‘ CZeilOOO 

c - ise T0> take SCALAR OCT proolct of TRANSPOSE OF' : ' C28I1100 

C TENSOR C ml TH VECTOR XI , - C2ei 12C0 

C NE ED EC SINCE TENSCRS IN STMMERIC MATRIX OF INERTIA TENSORS ARE IN C 281 1 300 

,C NCN SYMMETRIC* C2811400 

' 'IMPLICIT REAL*8lA-F.O-2.*»' • ' • . C2EI1S00 

CIMENSICN 01 3.2) .XI 13) .X<3> C28H600 



• CO l 

►M 

II 

U 

C28U700 


X( I) 

= c 

C2Ei i eco 

f ; 

CO 1 

J=l . 3 

, C281 1900 

* > ■ 

*i i) 

= III! ♦ 0( J . I)*X1< .1; 

- C2ei20CO 


1 CONTINUE a ' . - C 2 612100 

• RETURN ■ • , !L‘i t S.C281220C 

r" ; S'.r'.- FNC . ' •* ...*a . ' C 261 2300 




, . SU8RCLT 1NE VCC YOV I VI ,DT . VZ .X) C2EI 2400 

C - . • COMPUTES THE SCALAR TRIPLE PRODUCT - C2ei2500 

<C ' VECTCR . 1 0 TAD i . VECTOR ) ' «. • " '-€.2612600 

- C’ ~ ' ’ Vt.lOT.V2)' - C28I2700 

IMPL ICI T REAL *81 A-h.C-Z . 1 » ‘ ‘ ' ' ’ v ‘ • ! C2 81 2800 

• • CIMENSILN V 1 ( 3 ) .OTI 3 . 3 > . V2t 3 1 . TEMl 3 ) ‘ ' C261290C 




' CC l’ * = 1 , 3 
TEM.K ) = 0,.0 0 " 

CO 1 J=1.3 , 

1 TE>( K > = T EM ( K ) ♦ or ( K . J >*V2< J) 

>. = c 

■ CC 2 3=1.3 

2 > = * + V1(J)*TEM(J) 

return 

ENC 


C2ei 3C00 
C2ei3100 
C2ei 3200 
C261 3300 
C2f 13400 
C 261 3500 
C2ei 36C0 
C281 3700 
C2E 1 3800 


. SUERCUTINE DYCF(V.C) 

C ^TRANSFORMS VECTOR VI INTC SKEW DYAD 

IMPLICIT KEAL*8( A-H.O-Z . J I 
C IMSE S1CN V (3 ) .0(3. 3) 

C ( 1 . 1 ) = 0 

0(1.2) = V ( 3 ) 

• ' c( i . ;• ) = - v ( 2) 

C ( 2 . 1 ) = — V( 3 ) 

C< 2.2) = 0 
- C( 2.2) = V( 1 ) 

C ( 3 . 1 ) = V ( 2 ) 

• C ( 3 . 2 ) = —VC1» 

C ( 3 . 3 ) = 0 
RE TURK 
ENC 


C261 3900 
C2ei 4000 
C2ei 4 i oo 
C 2 ei 4200 

C2ei 4300 
C28I4400 
C 28 1 4500 
C 2 ei 4600 
C2ei 4700 
C281 4800 
C 28 1 4900 
C28I5000 
C2 6 1 5 1 0 0 
C281 5200 
C281 5300 



subroutine SLEOP( VI .V 2 .XM.D) 



C2E15400 


IMPLICIT REAL*6( A-H ,0-Z . J > 



C2E1 5500 


CIMEKSICN VI ( 3) , V2 <3 ) ,C( 2 .3 > 



C281 5600 

c 

CSEO TU COMPUTE TEE PSLECC INERTIA TENSOR 



C2EI 5700 

c ' 

OF ECOY L AM 8 A ««ITF RESPECT TO THE ORIGIN OF NEST 

X-I 

ANO 

C281 5800 

c 

THE HINGE POINT 1-1 WHICH IS ON THE TOPOLOGICAL PATH 

F& CM 

C2EI 5900 

c 

BCOY 

1 TO BODY LAWBA 



C28I 6000 

c 

ELCCK G SUPPER GAM8A.SUE K-l.l-1 EOUATICN 2-55 

CF 

X — 732 — 7 1- 7 C 

C2ei 61 00 

c 


0 = XM*( ( VI . V2) «1 - V2 VI) 



C2616200 

c 

' 




C2ei6300 

c 

X* 

- SCAL AR 



C2ei6400 

c 

VI 

- VECTOR 



C2EI6500 

c 

v 2 

- VECTOR 



C 281 6600 

c 

l 

- UNIT DYAO 



C2ei6700 

c 


- SCALAR. MULTIPLICATION 



C2ei 6800 

c 

• 

t VECTOR SCALAR MULTIPLICATION 



C261 69C0 

c 

elank 

-TENSOR MULTIPLICATION 



C281 7 CC 0 

c. 

NCTE 

that in general, the psueoo inertia tensor is 

NON 

5YVMETF I C 

C2E17100 

c • 

- C ( 1*1) 

= XM*(Vl(2 >*V2(2) ♦ Vl(J)*V2(3>) 



C2E1 7200 
C281 7300 


- C C 1 • 2 ) 

= -XN* V2( 1 ) *V1 ( 2 ) 



C2ei 7400 

■ 

= . c ( 1 . ;* > 

= -XM* V2 ( 1 ) «V1 (3 ) 


• - 

C2EI 7500 


: : ’ c <,2 . i > 

, = -XM* V2 (2) *V1 ( l ),,, 



C 28 I 7600 

■ 

: * c( ) 

= XM*( V2( 1 >*V1 ( f) f V2( 3 ) *Vl < 3) ) 



C2E1 7700 


. C< 2 . j ) 

=-XM*V2(2 ) *V1 ( 3 ) 



C261 7800 


c ( 2 . i > 

= -XM*V2(3) *V I ( 1 ) 



C28I 7900 


A-154 


n n 


C(2.2) a-XM* V2(3) ♦ VI (2 I 
s- : C(2.2) = XM*< V2I 1 )*V1 ( 1 ) * V2(2)*V1(2)) 

FE TURN 
ENC 


C26I 8CC0 
C26I8IOO 
C2et 8200 
C2E1 8300 


SuefiCUTINE UUTMUL COI.C2.P) 


C2500000 

C29D0100 

IMPLICIT REAL*B( A-h . 0-Z . T ) 


C2900200 

C I ME NS ION Q 1 ( 4 ) .02(4 ) .P< 4 ) 


C2900300 

MULTIPLIES TaO QUA T EN IONS AMD PUTS PRODUCT IN P 


C2900400 

P=01*02 


C2900500 

aH ERE 


C2900600 

* = QUATERNION MULTIPLICATION 


C2 900 700 

AO = Qi ( n 


.. ,.(2900800 

At a Q1 (£) 


C2900900 

A2 = Cl 12) 


02901000 

A3 a 01(41 


C2901 100 

EO a C211) 


' C 2901 200 

El = 02(2) 


C 290 1 300 

E2 = 02(2) 


C2901400 

E3 = 02(4) 


C 290 1 500 

P ( 1 ) = AC*ao - A1*E1 - A2*B2 - A3*B3 


C2901600 

F ( 2 ) a AC*b) ♦ A 1 *8 0 ♦ A 2* 8 2 - A3*B2 


C2901 700 

P ( 2 ) = AC*d2 - Al*e3 ♦ A2*e0 + A3*B1 


, C2 901800 

P(4) a A C*Q3 ♦ A 1 *B2 - A2*Bl A3*B0 


C2 901 900 

RE TURN 


C2902000 

ENC 


C2902100 


EUERCUTINE QUA TOP I OF • TH A • Z T ) 

IMfUCIT RtAL*a(A-hiO-Z,1l - ’ „ 

CIMENSICN QF(3).ZT<4) ' 

C COMPUTES ROTATION QU A T ER MCA FROM EIGENVECTOR OF AND ROTATION 

ANCLE THA, EQUATION A- 1 1 OF X-732-71-89 _ . ‘ . 

ZT ( l ) a • CCOS ( THA/2 > . A ' 

£ a CS IN ( ThA/ 2 1 ‘ 

CO l J = 2 • 4 
1 ZT CJ ) = CF( J-l 1*5 
RETURN 
•' ENO 

■’ : ‘ » ti- i - * 


C 2502200 
C 2 502300 
C2902400 
C2S02500 
C2902600 
C2902700 
C2902800 
C29C2900 
C2903000 
C2903100 
C 2903 200 


'I r 


C 

c 

c 

c 

c 


‘ 4 •* V i 

■* * • »v ■» * • '• •; ' - T "« ' T '*-*• « n. - 1 '3 ~ a-.* , - J f r.H r 7 1 \* . -v 

SUBROUTINE TRANSO(GML.SL) C2903300 

IMPLICIT REAL*8( A-F.O-Z. *) C2S03400 

CIMgMSlUN GML( 4) ,SL<3.2) C2903500 

‘ C 2903600 

MATRIX OPERATOR CONSTRUCTS THE QUATERNION T fi AN SF GRM AT ION ' MA TR ix ‘SL C2903700 
FRC.M JFE COMPONENTS CF THE QUATERNION GML(K) . . , C2903800 

THE EQUATION EVALUATE IS THE TRANSPOSE OF A-lb OF X-732-7 1-89 C2903900 

THAT IS,-L€T 12-9&4C&0 


A-155 


c 


GML(K) = ( £0 .El . E2 .E3) 

C2904 100 

c 

ThEN 


C2S04200 

r 



C 29 04-300 

C 

£C**2*El»*2-t2**2-E3«*2 2 ( E C *C J*E 1 «E2 > 2 < E 1*E3-E0*E2 ) 

C2904400 

c 

2( El 4E2 

-E0*E3) E0*42-E1»*2*E2**2-E3**2 2 { E2* E3 *E0*E 1 ) 

C 2904500 

c 

2( £ 1 «E3*£0*E2> 2 ( E2 4EJ-E0 *E l > E 0**2-E 1 ** 2-E2 ** 2 ♦ E 

2* C29C4600 

c 



C290470C 

c 


SL 1 1.1) SL( 1 .2) SL ( 1 .3 ) 

C2904800 

c 


= SL12.11 SL (2.2) SL (2.3) 

C2904900 

c 


SU3.1I EL (3.2) SL (3.3) 

C290SOOO 

c 



C2905100 

c 



C290S200 


EO 0 = GKL( 1 1 *GML( 1 ) 

C 2905300 


EO 1 = GK.L( 1 ) *GML( 2 ) 

C290S40P 


£02 - fil»LU)*GME(’) 

C2905500 


EC 2 * GML( 1 ) *GML ( 4 ) 

C29C5600 


Ell • G*Ll 2) *GML( 2 ) 

C29057C0 


£12 = G*L(2)*GML( 21 

C 290 580 0 


E.l 2 = GKL(2)*GMLC4) 

C29C5900 


E2 2 = GML( 3) *GML( 2 ) 

C29C60C0 


E2 2 = GML{ 3) *GMLl 4 ) 

C29061 00 


■ E32 = GML(4) *GML(4> 

C290E200 


SL ( 1 . 1 > 

= EOC ♦ Ell - E22 - E33 '■ 

C29C6300 


SL 1 1 .21 

= 2*(EC3 ♦ E12 > 

C29C6400 


£L(1.2) 

= 2*(E 1 3 - E02 ) 

C2906500 


SL < 2 • 1 > 

= 2* (£12 - E03) 

C29066C0 


SL (2 »2> 

= EO 0 - Ell ♦ E22 - £33 

C2906700 


SL(2 .2 1 

= 2 * ( E 23 > EC1 ) 

C2906e00 


£1. ( 3 . 1 » 

= 2*(E13 4 E02) 

C 2 906900 


SL(3.2) 

= 2* (E23 - EC1 ) 

C29C7000 


EL ( 3 . 3 ) 

= EO 0 - Ell - £22 * E33 

C29071 00 


RE 1UEN 


C2907200 


ENC 


C 290 7300 


A-156 
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APPENDIX B 


SUPPORT PROGRAMS FOR N-BOD2 
FLEXIBLE BODY CAPABILITY 


The flexible body options available in N-BOD2 require the user to obtain several resultant 
mode dependent parameters. These parameters will, for most applications, be computed from 
lumped parameter data obtained via the standard in-house finite element program. NASTRAN 
is the standard program at NASA/GSFC; however, other installations make use of other pro- 
grams. Therefore, as a guide for the interested user, the following two programs are submitted 

✓ 

and can either be used directly or be extensively modified to suit the situation existing at the 
particular computer installation that N-BOD2 will be applied. 

The first program is actually the NASTRAN Executive Control Deck for a specially written 
DMAP program. This DMAP program will output all lumped parameter data necessary for 
the generation of the required N-BOD2 resultant mode dependent parameters. The program 
DISCOS referred to in the DMAP listing is another flexible body program being prepared by 
H. P. Frisch for release at GSFC. It requires similar data but in a completely different format. 

This DMAP program is operational on the Macneal-Schwendler version 38 of NASTRAN and 
the Level 15.5 NASA version with one trivial change in the functional module GP4. (Built-in 
NASTRAN error messages will point out the change.) 

The DMAP program was written so that, in addition to modes and frequencies (real), NASTRAN 
could be forced to output modal mass, stiffness, and damping matrices. Several print and 
punch options were also built in so that the user could see more clearly some of the resultant 
mass stiffness and damping matrices internally generated by NASTRAN. The interested user 
is referred to a NASTRAN Level 15 User’s Manual (Reference 1) and Programmer’s Manual 
(Reference 2) for a detailed description of the DMAP program. Basically it is a combination 
of rigid formats 3, 9, and 1 2. 


ft 



Preceding Page Blank 



ID FRISCH, DISCOS N-BOD2 NASTRAN 

DIAC, i4 
TIMF 6000. 

APP' DM A P 

BEGIN DISCOS AND N-B0D2 DATA VIA NASTRAN * 

FILE * 

GP1 GE0M1 ,GE0M2,/GPL , EQEX I N , GPDT , CSTM , BGPDT , S I L /V , N, LUSET/ C,N, 123/ 
V » N , NOGPDT $ 

SAVE LUSET, NOGPDT * 

CHKPNT GPL,EDEXIN,GPDT,CSTM,BGPDT,S1L $ 

PARAM //C*N,N0P/V»Y,PRTGD=1 f 
COND LBL10, PRTGD * 

TABPT GPL,EOEXIN,GPDT ,BGPDT , S I L / / S 

TABPRT GPL//C,N,GPL S 

TABPRT GPDT//C,N,GPDT $ ' •- 1 

TA8PRT BGPDT//C,N,BGPDT S 

LABEL LBL10 t '*• 

PURGE US.ET,GM,GO,KAA,BAA,MAA,K4AA,PST,KFS,OP,EST/NOGPDT * 

CHKPNT USET,GM,GO,KAA,BAA,MAA,KAAA,PST,KFS,OP,EST $ 

GP2 GEOM2,E0EXIN/ECT S 
CHKPNT ECT J. 

T A 1 , , ECT,EPT,BGPDT,SIL, ,CSTM/EST, ,GEI , EC PT , GPCT/V, N , LUSET/ C,N, 

123/V,N,N0S IMP/C, N,0/V ,N,NOGENL/V,N,GENEL S 
SAVE NO&ENL,NOS IMP,GENEL t 

CHKPNT EST,GEI ,ECPT ,GPCT S ‘ 

PURGE K4GG, GPST ,OGPST,MGG,BGG, K4NN , K4FF , K4 A A , MNN , MFF , MAA , BNN, BFF , 
BAA,KGGX/NOS IMP/ OGPST/GENEL i 

CHKPNT K4GG,GPST,0GPST,MGG,BGG,K4NN,K4FF,K4AA,MNN,MFF, MAA, BNN.BFF', 
BAA,KGGX $ 

SMA 1 CSTM,MPT,ECPT,GPCT, DIT/KGGX,K4GG,GPST/V,N,N0GENL/ v,n,nok^gg$ 

SAVE NOK4GG S 

CHKPNT KGGX,K4GG,GPST i> 

PARAM / /C , N , NOP /V ,Y,PRTKG=-1 * 

COND LBL14,PRTKG t , • 

MATPRN KGGX ,,,,// S 
LABEL LBL14 $ 

PURGE K4NN ,K4GG,K4FF,K4AA/N0K4GG $ 

CHKPNT K4NN,K4GG,K4FF,K4AA S 

SMA2 CSTM,MPT,ECPT,GPCT,DIT/MGG,BGG/V, Y,WTMASS=1.0/V,N,N0MGG/ V,N, 
NOBGG/V, Y,C0UPMASS=-1 $ 

SAVE NOMGG,NOBGG * 

CHKPNT MGG, BGG S 

PARAM //C,N,NOP/V, Y,PRTMG=-1 S 

COND LBL 1 1 , PRTMG S 

MATPRN MGG,,,,// $ ‘ 

LABEL LBL 11 $ 

PARAM / /C , N , NOP/ V ,Y,PRTMGD=1 $ . "" 

COND- • -LBL15, PRTMGD S - .. 

DIAGONAL MGG/MMG/C ,Y,0PT=C0LUMN/V,Y,P0WER=1« - 

MATPRN MMG, , , , // $ 1 

LABEL LRL15 $ 

PURGE BNN,BFF,BAA,BGG/NOBGG $ 

CHKPNT BNN,BFF ,BAA ,BGG $ \ 

COND LBL 1 , GRDPNT $ 

GPWG BGPDT ,CSTM,EOEXIN ,MGG/OGPWG/ V ,Y,GRDPNT=-1/V,Y,WTMASS S 

CHKPNT OGPWG $ 

OFP- OGPWG, ,,, ,//V,N,CARDNO * 

SAVE CARDNO S 
LABEL LBL1 S 

PARAM //C,N,MPY/V,N,NSK! P/C , N , 0/C , N , 0 S 

BA 



I 


GP4 CASECC » GE0M4 *EOEXIN,S IL ,GPOT , BGPDT , CSTM /RG, , USET , /V , N , LUSET/ 
V,N,MPCF1/V,N,MPCF2/V,N,S1NGLE/V,N,0MIT/V,N,REACT/V,N,NSKIP/ 
V,N, REPEAT/ V,N,N0SET/V,N,N0L/V,N,N0A/C,N,0 S 
SAVE MPCF1, S INGLE, OMIT, NOSET, RE ACT »MPCF2»NSK IP, REPEA T,NOL»NOA S 

CHKPNT RG,USET $ 

PURGE GM, GMO/MPCF 1 /GO, KOOB , LOO, UOO, MOOB, MO AB, GOD/OMIT /KFS, P ST, OP/ 
SINGLE S 

CHKPNT GM, GMD, GO, KOOB , LOO , UOO, MOOB, MOAB, GOD, KFS,PST »OP S 
EOUIV KGGX,KNN/MPCF1/MGG,MNN/MPCF1/ BGG.BNN/MPCFl /K4GG .K4NN/MPCF1 t 
CHKPNT KNN,MNN,BNN,K4NN,0GPST S 
GPSP GPL, GPS T ,USET,SIL/QGPST $ 

OFP OGPST , ,, , »//V,N,CARDNO t 
SAVE CARONO $ 

COND LBL2.MPCF1 $ 

MCE 1 USET *RG/GM S 

MCE2 USET,GM,KGGX,MGG,BGG,K4GG/KNN,MNN,BNN,K4NN S 
CHKPNT GM,KNN,MNN,BNN,K4NN $ 

LABEL LBL2 t 

EOUIV KNN,KFF/ S 1NGLE/MNN, MFF/S INGLE /BNN, BFF/ S1NGLE/KANN,k4fF/ SINGLE $ 
CHKPNT KFF, MFF , BFF , K4FF $ !' 

COND LBL3, SINGLE i 

SCE 1 USET, KNN, MNN , BNN, K4NN/KFF.KFS, , MFF ♦ BFF , K4FF $ 

LABEL LBL3 $ 

EOUIV KFF, KAA/OM IT/ MFF , MA A/OM I T /BFF ♦ BA A/OM I T/ K4FF » K4 A A/OM I T $ 

CHKPNT KAA,MAA,BAA,K4AA $ 

COND LBL20,0M IT . $ . 

SMP1 USET, KFF,, BFF, K4FF/GO.KAA, KOOB, LOO, UOO, ,», BAA, .K4AA $ 

CHKPNT G0,KAA,K008,L00,U00,BAA»K4AA S 
SMP2 USET ,GO,MFF/MAA $ 

CHKPNT. MAA $ 

LABEL LBL20 $ 

PURGE KRR,KLR,DM,MLR,MR/REACT/CM/MPCF1/G0/0MIT/KFS/SINGLE/0G/N0SET t 
COND LBL21, REACT S 

RBMGI USET, KAA,MAA/KLL,KLR,KRR,MLL. MLR, MRR $ 

CHKPNT KLL,KLR,KRR,MLL,MLR,MRR S 
RBMG2 KLL/LLL.ULL $ 

CHKPNT ULL.LLL $ 

RBMG3 LLL,ULL,KLR,KRR/DM $ 

CHKPNT DM $ . 

RBMG4 DM,MLL,MLR,MRR/MR J> 3 

CHKPNT MRS < 

LABEL LBL2I $ 

OPO DYNAMICS, GPL jS IL ,USET/GPLD, S ILD.USETD, , , , , , , EED, EODYN/V.N, 

LUSET/V,N,LUSETD/V,N,NOTFL/V,N,NODLT/V,N,NOPSr)L/V,N,NOFRL/V,N, 
NOMLFT/V,N,NOTRL/V,N,NOEED/C,N, 123/V,N,NOUE S 
SAVE NOEED,NOUE S 

CHKPNT GPLD,SILD,USETD,EED,EODYN S 
COND ERR02 , NOEEO 

READ KAA,MAA,MR,DM,EED,USET,CASECC/LAMA,PHI A, MI .OEIGS/C^MOOES/ '’ V? 

N, NE I GV t ’ ' ' 

SAVE NEIGVS 

CHKPNT LAMA, PHI A, MI ,OE IGS S 

ADD MI,/OI/C,N, ( 1. -10, 0.O) t " 

OFP LAMA,OEIGS,,,,//V,N,CARDNO $ ' 

COND FINIS, NEIGV S 

SOR I USET,,PHIA,,,G0,GM,,KFS,,/PHIG,,0G/C,N,1/C,N.REIG S >'• 

CHKPNT PHIG,OG i 
P ARAM //C,N,NOP/V, Y,PRTM0=1 $ 

COND LBL12 »PRTMD $ 

MATPRN PHIG,,,,// S 
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LABEL LBL12 $ 

SDR2 CASECC,CSTM,MPT,DI T,EOEXIN, S IL, , ,BGPDT,LAMA,OG, PHIG,EST, /,0QG1 » 
OPHIG,OESl,OEFl.PPHlG/C,N,REIG S 
CHKPNT OOGl,OPHIG,OESl,OEFl,PPHIG $ 

OFP OPHIG,OOGl t OEFl ,OESl , , //V , N , C ARDNO S 

SAVE CARONO $ 

EOUIV GO* GOD/NOUE /GM , GMD/NOUE $ 

CHKPNT GOO « GMD $ 

MTRXIN CASECC *MATPOOL , EODYN , , /K2PP * M2PP « B2PP/V *N» LUSE TD/V * N * NOK2PP/V * 
N,NOM2PP/V,N,NOB2PP S 

SAVE NOK2PP,NOM2PP»NOB2PP Jn • ! 

CHKPNT K2PP*M2PP*B2PP $ 

PARAM //C,N,ANO/V,N,KDEKA/V,N*NOUE/V,N,NOK2PP Z 
PARAM //C,N, AN0/V,N*M0EMA/V,N,N0UE/V,N,N0M2PP Z 
PARAM / /C » N , AND/ V * N »KDEK2/ V *N ,NOGENL /V *N * NOS1 MP $ 

PURGE K2DD/N0K2PP/M2DD/N0M2PP/B200/NDB2PP $ 1 

EOUIV M2PP,M2DD/N0A/B2PP,B20D/N0A/K2PP , K 20D/N0 A/M A A , MDD/MOEMA / K A A * 
KOO/KOEKA 

GK AD . USETD,GM,G0,KAA,BAA,MAA,K4AA,K2PP*M2PP*B2PP/K0D, BDD* MOD* GMD, 

GOD, K2DD, M2DD, B2DD/C, N, TR ANRE S P/C*N,D I SP/C,N, DIRECT /C, Y,G=0.0/ 
C,Y,W3=0.0/C,Y,W4=0.0/V,N,N0K2PP/V,N,N0M2PP/V,M,N0B2PP/ V,N, 
MPCFI/V,N,SINGLE/V,N,OMIT/V,N, NOUE /V,N,NOKAGG/V,N» NOBGG/ V,N, : 
KDEK2/C ,N ,-l $ 

CHKPNT M2DD,B2DO,K2DD,MDD,KDD,BDD,GMD, GOD $ 

GKAM USETD,PHIA,OI,LAMA,OIT,MDO,BDO,KDD,CASECC/MHH,BHH,KHH, 

PHIDH/V*N,NOUE/C,Y,LMODES=0/C,Y,LFRE 0=0.0/ C, Y .HERE 0=0.0 /C,N, 
1/C,N,1/C,N,1/V,N, NONC PU / V ,N , FMODE 5> 

CHKPNT MHH,BHH,KHH,PHIDH $ 

PARAM //C»N,NOP/V ,Y,PRTMM = I $ 

COND LBL13, PRTMM S 

MATPRN KHH,BHH,MHH,PHIDH,// $ 

LABEL LBL13 $* 

PARAM //C,N,N0P/V,Y,PCHGD=-1 S 
COND LBL6, PCHGD i 

TABPCH GPL,BGPDT,,,//C,N,GP/C,N,BG $ 

LABEL LBL6 $ 

PARAM //C,N,N0P/V,Y,PCHMG=-1 $ 

COND LBL 7, PCHMG * 

0UTPUT3 MGG, , , , / /C , N, 0/C , Y ,N I =MMG S 
LABEL LBL 7 $ 

PARAM //C,N,N0P/V,Y,PCHM0=-1 $ 

COND LBL8, PCHMD t 

OUTPUTS PHIG, , , ,//C,N»0/C,Y ,N1=PHG $ 

LABEL LBL8 $ 

PARAM //C,N,NOP/V, Y,PCHMM=-1 $ 

COND LBL9,PCHMM $ 

OUT PUT3 KHH,BHH,MHH,,//C,N,0/C,Y,N1=KKH/C,Y,N2 = BBH/C, Y,N3=MMH t 
LABEL LBL9 $ 

JUMP F IN I S$ 

LABEL ERR02 $ •• 

PRTPARM //C,N, -2/C, N, MODES $ 

LABEL FINIS S 
END $ 

CEND 
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NASTRAN is extremely inflexible in allowing the user control over output data formatting. 
Consequently, a preprocessor program must be available to read the NASTRAN generated 
data. The next program is designed to not only read the data but also to process the data 
and compute the input data required by both N-BOD2 and DISCOS in respectively acceptable 
format. 

For N-BOD2 users, the resultant mode dependent parameters are outputted on the line 
printer and annotated with the same acronyms used in the coding of the read data statements 
in subroutine INOPT. 


C . . 

C 

C DISCOS, N-R0D2 PREPROCESSOR OF NASTRAN GENERATED 


READ ONE OR MORE NASTRAN GENERATED TAPES 
WRITE ONE INPUT TAPE FOR DISCOS PROGRAM 
CONTAINING FLEXIBLE BODY DATA FOR ALL 
FLEXIBLE ROD I E S IN S i MUL AT I ON 
COMPUTE RESULTANT MODE DEPENDENT PARAMETERS 
FOR GSFC MULTI-FLEXIBLE BODY PROGRAM. 

N-B0D2, THIS SECTION OF NO INTEREST TO 
DISCOS USERS 

c ‘ * ‘ 

C DEFINITIONS: ’ : "V ' \ 

c •' ■ 

C DATA SET 1 = SCRATCH FILE USED TO PROCESS NASTRAN DATA 

C 

C DATA SET 2 = DISCOS INPUT TAPE (THE OUTPUT TAPE OF THIS PROGRAM) 

C THE CARD OUTPUT OF THIS PROGRAM ASSUMES THAT DATA SET 1 A. IN. 

C DISCOS WILL RE RESERVED FOR THE FLEXIBLE BODY DATA 

C ' ' • 

C DATA 

C 

C DATA 

C 
C 
C 

C DATA 

C 

C - ' 

c 
c 
c 
c 

I M PL 
C 

DATA 
DATA 
DATA 


SET 3 = SCRATCH FILE USED TO REDUCE CORE REQUIREMENTS' 

SET 11 = LOCATION IN SYSTEM OF NASTRAN TAPE ASSOCIATED WITH 
THE FLEXIBLE BODY IN DISCOS HAVING LOWEST MAGNITUDE 
INTEGER LABEL 

» ■ : , • f • . ’ J ■ ■ 

SET 12 = LOCATION IN SYSTEM OF NASTRAN TAPE ASSOCIATED WITH 

THE NEXT FLEXIBLE BODY IN THE DI SCO S, ftODE L . , , V 

H,V, '■ -.W. Y < .1 \MX>.- ■ j H, Y T J \ U , W ♦ LIuMou 


ETC. PROGRAM DIMENSIONED FOR A MAXIMUM. OF 6 NASTRAN TAPES 

ICIT REALMS (A-H.O-Z) 

IDL/1HS/ 

ISTR, IBLK/lHfc, 1H / 

I GPL , IBGP, IMGG / AHGPL , 4HBGPD , AHMGG / 


C 

C 

C 

C 

C 

C 

C' 

C 

c 


PURPOSE : 


1 ) 
2 ) 


3) 


3 

DAT/? ‘ 



o o 


DATA ID, IT, I I/1HD, 1HT, 1HI/ 

DATA IR,1E,1S/1HR,1HE,1HS/ 

C 

INTEGER INPT(RO), IGRID(500), 1A(20), IB(20), 

* I COT ( 5 ) * I Y ( A ) 

INTEGER MSAVEI 100) ,MSTOTL ,H I NGE 

C 

REALMS X{500), Y(500), Z<500), 

* INERTA(6,6,500), PH I< 6 ♦ 500 , 1 2 ) , 

* KHH (12,12), RHH ( 1 2 1 1 2 ) * 

* MHH( 12, 12) , XX I 4 ) , X Y ( 4 ) 

C . 

REALMS AMOl 500, 72 ) 

C 

COMMON /WORK/ AMO 
C 

EQUIVALENCE ( AMO ( 1 , 1 ) , PH I ( 1 , 1 , 1 ) ) 

EQUIVALENCE ( AMD ( 1 , 1 ) , X (1) ) 

EQUIVALENCE ( AMD( 1 , 2 ) , Y ( 1 ) ) 

EQUIVALENCE ( AMD ( 1 , 3 ) , Z (1) ) 

EQUIVALENCE ( AMD ( 1 , 4 ) , I NERT A ( 1 , 1 , 1 )) 

C 

LOGICAL L ECHO, L PUNCH, LCHECK,LN AST 
LOGICAL LRSTRT 


100 FORMAT ( I5,3L5,2I5,L5 ) 

101 FORMAT < 4A4 , 7 I 8 , 2A4 ) 

102 FORMAT ( 2A4, 818) 

103 FORMAT ( 4A4 , 5 I 8 , E 1 6 . 9 ) 

104 FORMAT (2A4,2E16.9, I16.E16.9) 

105 FORMAT <2A4,2E16.9) 

106 FORMAT (110) 

108 FORMAT ( 4A4 , I 8 , 2 1 1 6 , E 1 6 . 8 ) 

109 FORMAT (10E13.5) 

110 FORMAT (6E15.5) 

111 FORMAT (1215) 

112 FORMAT ( • 1 • , I5,3L5,2I5,L5 ) 

113 FORMAT (IX, 2015) 

114 FORMAT ( *1*,5X, »******• MODAL DATA SELECTED FROM NASTRAN INPUT T At 
*E • » 14, • FOR PROCESSING ******«,//) 

.,115 FORMAT < 12X, 'MODE' , 14, • LISTED BELOW IS MODE', 14,' ON THE NASTRAN 

♦DATA TAPE') 

200 FORMAT (• NJOINT =',I5,' NUMBER OF GRID POINT LOCATIONS TO BE REAC 

♦ = ' * I 5, ' THESE SHOULD BE EQUAL') . ... 

201 FORMAT (' NUMBER GRID POINT X-LOCATION Y-L0CAT10N 

♦ Z— LOCATION • ) *. 

202 FORMAT <6X, 15, 7X, I5,2X,3E15.5 ) ,, . . , 

,,300 FORMAT (80A1) 

302 FORMAT ( 4A4 , I 8 , 2 1 16, El 6.8 , 2 A4 ) 

303 FORMAT ( 2A4,4E16.8, 2A4 ) 

400 FORMAT (2X.80A1 ) 

500 FORMAT (• ANOMOLOUS EOF MARK ON TAPE, LISTING FOLLOWS ') 

501 FORMAT (/,' INTERNAL GRIO POINT ',15,' EXTERNAL GRID POINT', 15,' 

*N THE NASTRAN BULK DATA DECK') " 

502 FORMAT (' X,Y,Z COORDINATES') 

503 FORMAT (6E20. 10) 

504 FORMAT (' LUMPED INERTIA MATRIX') 

505 FORMAT (• PHI (6 MODAL COMPONENTS FOR EACH SELECTED MODE)') 
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506 FORMAT ( // , • KHH • ) 

507 FORMAT <• 1 ', 5 X ,' ****** LUMPED PARAMETER AND MODAL DATA TO BE PROCE 
*S SED FOR DISCOS AND N-R002 INPUT DATA ****** < , /// ) 

508 FORMAT ( //, • BHH ' ) 

509 FORMAT ( //♦ ' MHH ' ) 

510 FORMAT (/////) 

511 FORMAT ( 2X , 'EXIT DECODE ' , A (I 8 , E 16 . 8 ) ) 

512 FORMAT ( 2X, ' ENTER DECODE ' , 2 1 8 , 4E 1 6. 8 ) 

600 FORMAT ( I5,3E20.8) 


READ TWO INPUT CARDS PER NASTRAN TAPE 
NT APE = DATA SET WHERE TAPE I S TO 
BE FOUND NTAPE = U,12t... 

LECHO = .TRUE. PRINT ECHO OF PROCESSED DATA 

= .FALSE. PRINT ONLY IF ERROR FOUND ON TAPE 
L PUNCH = .TRUE. PUNCH PLOT DATA y 

= .FALSE. DON'T * 

LCHECK = .TRUE. PRINT DATA IN/OUT OF DECODE 

= .FALSE. DON'T 

HINGE = GRID POINT NUMBER OF HINGE POINT AS 
DEFINED BY USER IN NASTRAN BULK DATA 
MSTOTL = TOTAL NUMBER OF FLEXIBLE BODY MODES TO 
PROCESS FOR DISCOS AND N-B0D2 DATA 
LNAST = .TRUE. PRINT NASTRAN DATA INPUT 
.FALSE. DON'T 
MSAVE = MODE SAVE ARRAY 

MSAVE(K) = 0 SKIP MODE K DATA 

• • K PROCESS MODE K DATA 

REWIND 2 
1 CONTINUE 

READ(5,100,END=4) NT AP E , L ECHO , L PUNCH , LCHECK , H I NGE , M ST OT L . L MAS T 
WR ITE ( 6, 1 12 ) NT A PE, L ECHO, L PUNCH, LCHECK, HINGE , MSTOTL , LNAST 

READ (5,111) ( I A ( I ) , 1 = 1 , MSTOTL ) 

DO 11 1=1,100 

11 M S A VE ( I ) = 0 i 

DO 12 1=1 , MSTOTL 

12 MSAVE ( I A ( I ) ) = I ; 

WR I TE ( 6, 1 1 3 ) MSAVE ,• 

REWIND NT A PE ■■ 

LRSTRT = .FALSE. NO RESTART CARn'S' 'o'N NTAiPE 
= .TRUE. RSTAKT CARDS ON NTAPE 
ICNTRS = 0 . 

, LRSTRT = .FALSE . 

9 READ (NTAPE, 300, END = H ) INPT 

IF(LNAST) WR1TE(6,400) INPT , • .■ 

. ‘ a C 1 *J . V /» > V « ' C f* '■ t - -A V A O t I *.»•.. I .kv J 

C CHECK FOR RESTART CARDS - n.-.~ 

' IF( IR.NE. INPT( 1 ) ) GO TO 9 
I F ( IE.NE. I NPT ( 2 ) ) GO TO 9 
I F ( IS. NE. INPT (3) ) GO TO 9 
I F ( IT.NE. I NPT ( A ) ) GO TO 9 

C COME HERE FOR RESTART CARDS, COUNT THEM AND SET FLAG 

LRSTRT = .TRUE. 

ICNTRS = ICNTRS +1 , 

13 READ (NTAPE, 300, END = 8 ) INPT , 

I F ( LNAST ) WR I TE ( 6 , 400 ) INPT ( 

I F ( ID.EO. INPT( 1 ). AND. IT. EC). INPT(2 ) .AND. I I .EO.INPTI 3) ) GO TO 9 
ICNTRS = ICNTRS +1 
GO TO 13 
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A CONTINUE 

. . REWIND NT A PE . . . .*> 

REWIND I. 

REWIND 3 
I CNT = 0 . 

IBLK =0 
DO 7 1=1,5 

7 ICOT ( I ) = 0 - 

C 

C READ ALL DTI CARDS FROM NASTRAN TAPE NT APE TO OBTAIN 

C 1) GRID POINT NUMBERING SEGUENCE SET UP BY NASTRAN 

C 2) GRID POINT LOCATIONS 

C 

C **** NOTE **** 

C : ■ - • - 

C NASTRAN WILL RENUMBER GRID POINTS DEE I NED BY . USER 

C INTO A SEQUENCIAL SET. THIS IS USED FOR INTERNAL NASTRAN 

C COMPUTATION AND WILL BE USED BY DISCOS T 

C 

C SKIP RESTART CAROS IN FRONT OF GOOD DATA 

IF( .NOT.LRSTRT ) GO TO 2 - 

DO 14 1=1,1 CNTRS 
1A READ (NTAPE,300,END=3) INPT 

2 READ (NTAPE,101,END=3) ( I A ( I ) , I = 1 , A ) , ( I B ( I ) , I = 1 , 7 ) ♦ ( I A ( I ) , I =5 , 6 ) 

C CHECK .FOR TABLE HEADING ■> . 

IF< I A ( 3) .EQ. IGPL ) GO TO 50 
I F ( IA<3) ,E0. IBGP) GO TO 60 
IF( IA(3).E0. IMGG) GO TO 70 
GO TO 2 

ERROR ON TAPE 

3 CONTINUE 
WRITE! 6,5001 

6 REWINO NT APE 

5 READ (NTAPE,300,END=A) INPT 
WRITE! 6,400 ) . INPT 
GO TO 5 
A STOP 

COME HERE TO PROCESS GPL' TABLE DATA 

50 CONTINUE 
I CNT = I CNT +1 

IF! ICNT.NE.l > GO TO 51 ■ j,; i i 

NJOINT = IBC2) ... . . . 

C NJOINT = NUMBER OF GRID POINTS IN MODEL 

GO TO 2 -|V : t b«. : - 1 i ■' -s 

51 IF! ICNT.NE.2IG0 TO 52 
DO 53 J* 1,6 

53 I GRID! J ) = IB1J+1) 

NC => (NJOINT-6) /8 
00 54 J= 1 »NC 

JJ = 7 + 8*! J-l ) 

JJ7 = JJ+7 

54 READ! NTAPE. 102 I ! I A ! I ) , I = 1 , 2 ) , « IGR I D ! I ) , I = J J . J J7 ) 

JJ = 6 ♦ 8*NC 

JJi = JJ+1 

IF! JJ.EO. NJOINT) GO TO 2 

READ(NTAPE»102) ! I A ! I) , I = 1 , 2 ) . ( I GR ID ( I ) , I = J J 1 ,N JO I NT ) 

GO TO 2 

C I GR I D ( I ) =USER DEFINED GRID POINT NUMBER 
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C 

c 


WHICH NASTRAN HAS RELABLED TO 

BE INTERNAL NUMBER I ' 


52 ICNT = 0 

NC =' ( NvlOINT-B I /4 
IF(NJ0INT.EQ.4#NC+3 ) r,0 TO IB 
NC = NC + 1 
IB on 15 1=1, NC 
15 READ ( NTA PE , 300 ) INPT 
GO TO 2 


COME HERE TO PROCESS BGPDT CARDS 

BO CONTINUE 

IF( IR(2).EQ.NJ0INT) GO TO 61 

ERROR ' • 

WR I TE ( 6, 200 ) -N JOINT, IB(2) 

■GO TO 6 

61 READ ( NT A PE , 300 ) INPT 

READ INTAPE, 103) < I A ( I ) , I = 1 , 6 I , < I R ( I > , I =1 , 5 I , X ( 1 ) 

00 62 J=2,NJ0INT 

62 READ { NTA PE , 104 ) ( I A ( I ) , I = 1 , 2 ) , Y ( J- 1 ) , 2 ( j - 1) , I B ( 1 ) , X ( J ) 

J = N JO I NT - : 

READ ' ( N T A P E , 1 6 5 ) ( I A ( I ) , I = 1 , 2 ) , Y ( J ) , Z ( J ) 

GO TO 2 

SAVE LOCATION DATA, WRITE IT 'ON TAPE 3 AFTER INERTIA : DATA 

X ( J ) = X-COORDINATE OF GRID POINT IG.RIO(J)'" 

Y ( J ) = Y-COQR 0 1 NAT E OF GRID POINT IGRIO(J) 

ZIJ) = Z-COORDINATE OF GRID POINT IGRID(J) 


STEP 1: 


STEP 2; 


COME HERE TO PROCESS ALL DMI CAROS ' 

COUNT CAROS IN EACH GROUP- 
ASCERTAIN FORMAT OF EACH CARO 
REWRITE ON SCRATCH FILE ALL CAROS 4 
PRECEEOEO BY THEIR FORMAT CODE 


• REWIND SCRATCH FILE 

READ CAROS OFF SCRATCH FILE WITH KNOWN • FORM AT ' 

LOAD ALL ARRAYS, SKIPPING ALL UNWANTED MODES', 

70 CONTINUE ( I 

RFWINO 1 :- : 

I FORM = 301 ' 

WR ITE ( 1 1 106 ) I FORM , U ' 

WRITE! 1, 101 ) ( I A ( IJ , 1=1 ,4) , ( I K( I ) , 1 = 1 ,7 ) , ( I A ( I ) , I =5,6,)' 

IBLK =1 , 

ICOTI IRLK ) = 1 

I F( IB! 2 ) .NE .6. OR. IB! 6) .NE . I B ( 7 ) .OR. I B<6 ) .NE.NJOTNT*fe ) GO TO. 71 
DO 76 1 = 1 ,NJOINT 
DO 76 J 1= 1 , 6 
DO 76 J2= 1 , 6 

76 INERTA! J1 ,J2, I )' =0.0 1 

GO TO 72 

71 CONTINUE = .. 

ERROR ' ■ 

WRITE (6, 101 ) ( I A ( I ) , I = 1 , A ) ,- ( I B ( I ) , I = 1 ,’7 ) , ( I A! I) , I = 5 ,;6 )' 

GO TO 6 

72 READ(NTAPE,300,END=80> INPT 

IF(INPT(A).NE.ISTR) GO TO 73 '* 


I ; 
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ICOTURLK) = ICOTURLK) + 1 
I FORM = 302 
GO TO 74 

73 IF( INPT( 1 >.EQ. ISTR) GO TO 75 

END OF DATA RLOCK I RLK 
CHECK FOR 'END OF CHECKPOINT DICTIONARY' 

I F < INPT(l) ,E0. IDL ) GO TO 72 
I BLK = I BLK + 1 
ICOT(IBLK) = ICOT(IBLK) + 1 
I FORM = 301 
GO TO 74 

75 CALL INTERPI INPT, IFORM) 

I COT ( I BLK ) = ICOTURLK) + 1 

74 WR I TE ( 1 , 106 ) IFORM 
'WRITE! 1,300) INPT 
GO TO 72 

80 END FILE 1 

t 

1 ALL DMI CARDS READ, FORMAT DEDUCED AND 

REWRITTEN ON SCRATCH FILE 1 


FORMAT CODES: 


301 

= 

FORMAT 

302 

= 

FORMAT 

303 

9 

FORMAT 

304 

9 

FORMAT 

305 

9 

FORMAT 

306 

9 

FORMAT 

307 

9 

FORMAT 

308 

9 

FORMAT 

309 

9 

FORMAT 

310 

9 

FORMAT 


(4A4, 718, 2A4 ) 

(4A4, I8,2I16,E16.8,2A4) 
<2A4,4E16.8,2A4) 

( 2A4 , 3 E 16 . 8 , I 16,2A4) 
(2A4,2E16.8» I16,E16,8,2A4) 

( 2A4 , E 16 . 8 , I16,2E16.8,2A4) 
(2A4,E16.8, I 16,E16.8, I 1 6 , 2 A4 ) 
(2A4,I16.8,3E16.8,2A4> 

(2A4, I16.8,2E16.8, I16.8.2A4) 
<2A4,I16,E16.8,I16,E16.8,2A4) 




START TO PROCESS DMI CARDS 

REWIND 1 

I F ( IRLK.LE.5 ) GO TO 20 

ERROR I BLK MUST BE LESS THAN OR EOUAL TO 5 
81 REWIND 1 

83 READ <1 ,300,END = 90) INPT 
WR I TE ("6 , 400 ) INPT 
GO TO 83 
90 STOP 
20 CONTINUE 

DO 22 I BK = 1 , I RLK 
ICBLK = ICOT ( IRK ) 

DO 21 JJ «1» ICBLK 

IF(JJ.NE.l) GO TO 23 , T fV% , r .... 

READ FIRST CARD OF OATA BLOCK “ 

READ (1,106) IFORM 

READ (1,101) ( IA( I ) , 1=1 ,4) , ( IB( I ) , 1=1 ,7 ) , ( I A( I ) , 1 = 5,6) ‘ 

I F ( IBK.NE.l ) GO TO 40 

INERTIA MATRIX 

I F ( I B( 2 ) .NE.6 ,OR,..IB (6) ,NE. I B ( 7) .OR. IB( 6) .NE.NJ0INT*6) GO TO 81 
SO FAR SO GOOD 
GO TO 21 

40 I F ( IBK.NE.2) GO TO 41 


MODE SHAPES 

I F ( IB(6).NE.6*NJ0INT) GO TO 81 
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NMODES = I B ( 7 ) 

NMODES = NUMBER OF MODES 
MSTOTl = NUMBER OF MOOES TO PROCESS 

DO 42 11=1,6 
DO 42 12=1 »NJO I NT 
00 42 13=1, MSTOTL 

42 PH I ( 11,12,13) = 0.0 
GO TO 21 

MODAL MASS, STIFFNESS AND DAMPING MATRICES 
41 IF( IB(6).NE.IB<7). OR. IB(7).NE. NMODES) GO TO 7.1 
00 43 11=1, MSTOTL 
DO 43 12=1, MSTOTL 
I F ( IBK.NE.3) GO TO 44 
KHHI 11,12) = 0.0 
GO TO 43 

44 I F ( IHK.NE.4) GO TO 45 
8HH( 11,12) = 0.0 
GO TO 43 

45 MHH ( 11,12) = 0.0 

43 CONTINUE 
GO TO 21 

\ READ IN DATA CARDS 

23 CONTINUE 

RE AO (1,106) I FORM 
I F ( IF0RM.NE.302 ) GO TO 24 

READ ( 1,302 ) ( I A ( I ) , 1 = 1 ,4) , I B ( 1 >,NNR,NNC,XX ( 1 ) , < I A ( 1 ) , I = 5 , 6 > 
NSR = MSAVE(NNR) 

NSC = MSAVE(NNC) 

I F ( IBK.NE.l ) GO TO 25 
NIT = (NNC-l>/6 + 1 
N2T = <NNR-l)/6 +1 
IF(N1T.E0.N2T) GO TO 26 
C ERROR 

WRITE (6, 302 ) ( I A ( I) , I = 1 , 4 ) , I B ( 1 ) , NNR ,NNC , XX ( 1 ) , ( I A ( I ) , I = 5 , 6 ) 
GO TO 81 

26 NT = NIT 

NC = MOD ( NNC-1 ,6) + 1 , 

NR = MOD ( NNR- 1,6) +1 
INERTA(NR,NC,NT ) = X X ( 1 ) 

GO TO 21 

25 I F ( IBK.NE.2 ) GO TO 27 
NT = (NNC-1 ) / 6 + 1 

NE = MOO ( NNC-1 , 6 ) + 1 . 

IF(NSR.EQ.O) GO TO 21 
PHI (NE, NT, NSR) = XX ( 1 ) 

GO TO 21 

27 I F ( IBK.NE.3) GO TO 28 ... ..." , ' . ' 

IF(NSR.E0.0.0R.NSC.E0.0 ) GO TO 21 ° ' 1 l,v- 1 1 

KHH ( NSR , NSC ) = X X ( 1 ) 

GO TO 21 , 

28 I F ( IBK.NE.4 ) GO TO 29 
IF(NSR.EO.O.OR.NSC.EO.O) GO TO 21 
BHH ( NSR , NSC ) = XX( 1 ) 

GO TO 21 

29 CONTINUE 

IF(NSR.E0.0.0R.NSC.E0.0 ) GO TO 21 
MHH( NSR ,NSC ) = X X ( 1 ) 

GO TO 21 
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24 CONTINUE 

FORMAT 4E16.8 FOR XX WILL READ INTEGER I WHICH IS RIGHT 
JUSTIFIED AS I * 1.0E-OR 

THIS IS EASILY UNDONE IN DECODE ’ ’ ' ' ‘ 

READ ( 1,303 ) ( 1A( I ) , 1 = 1 ,2) , (XX( I > , -1=1,4) , ( IA(I>, 1 = 3,4) ' 
IF(LCHECK') WRITE (6,512) I FORM , NNC , ( XX ( 1 ) , I = 1 , 4 ) 

CALL DECODE! IFORM, XX, NNC, XY, IY, NY) 

IF(LCHECK) WRITE (6,511) ( 1 Y ( I ) , XY ( I ) , I =1 , NY > 

DO 30 1=1 , NY 

IF ( IBK.NE.l ) GO TO 31 

NC MOD ( I Y ( I ) — 1 , 6 j + 1 “ ’} 

INERTA(NR,NC,NT) = X Y ( I ) 

GO TO 30 

31 I F ( IBK.NE.2 ) GO TO 32 

NT = ( I Y ( I ) — 1 ) / 6 + 1 ■' - r/ ' '■ 

NE = MOD ( I Y ( I)— 1,6) + 1 : *' ; 

IF(NSR.EO.O) GO TO 30 v W- 

PHI ( NE ,NT ,NSR ) = X Y ( I ) 

GO TO 30 - ■ 

32 IF( IBK.NE.3) GO TO 33 ' 8 

,NSC = MSAVE ( I Y ( I ) ) 

IF(NSR.EQ.O.OR.NSC.EO.O) GO TO 30 : • • 

KHH( NSR , NSC ) = X Y ( I ) • 

GO TO 30 ? ' 

33 I F ( I BK. NE .4 ) GO TO 34 
NSC = MSAVE ( I Y ( I) ) 
lF(NSR.EO.O.OR.NSC.EO.O) GO TO 30 
BHH ( NSR , NSC ) = X Y < I ) 

GO TO 30 

34 CONTINUE 

NSC = MSAVE(IY( I ) ) ' > 

IF(NSR.EO.O.OR.NSC.EO.O) GO TO 30 
MHH( NSR , NSC ) = X Y ( I ) 

30 CONTINUE 
21 CONTINUE 


I F ( I BK .NE . 1 ) GO TO 63 
REWIND 3 

WRITE (3) ( ( ( INERTA( I , J,N ) , 1 = 1,6) , J=l,6) ,N = 1,NJ0INT) 
WRITE (3) (X(N),Y(N)-, Z(N),N = 1,N JOINT) 

IF( .NOTiLPUNCH) GO TO 10 

WRITE (7,600) ( IGR IDI N ) , X ( N ) , Y ( N ) , Z ( N ) , N = 1 , NJO I NT ) . 

10 CONTINUE 

WRITE (6, 507) • 

DO 64 N=1,NJ0INT ? ‘ ‘ H •' f J A 8 Ti • :■<! 

WRITE (6,501 ) N, IGRID(N) 

WRITE (6,502) 

WRITE (64503.) X ( N ) , Y ( N ( , Z ( N ) 

WRITE (6,504) 

WRITE (6,503) ( ( INERTA ( I , J ,N ) , J= 1 , 6 ) , 1=1 , 6 ) 

64 CONTINUE * 

WRITE (6,510) ' ‘ ’ 

GO TO 22 ’* ' 

63 IF( IBK.NE.2) GO TO 65 - 

WRITE (3) ( ( (PHI ( I ,N,J ) , 1 = 1,6 ) , J = 1 ,MSTOTL ) ,N=1,NJ0INT ) 
IF( . NOT. L PUNCH) GO TO 67 ... 

DO 68 J=1,.MST0TL 

WRITE (7,600) ( IGRID(N) , (PHI ( I,N,J) ,1 = 1 ,3),N=1,NJ0INT) 
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68 CONTINUE 
67 CONTINUE 

WRITE (6,114) NT APE 
DO 17 1=1 »NMODES 
IF(MSAVEU) .EQ.O) GO TO 17 
WRITE (6,115) MS A VE ( I > , I 
17 CONTINUE 

WRITE (6,510) 

DO 66 N = 1 ,N JO I NT 
WRITE (6,501) N , I GR I 0 ( N ) 

WRITE (6,505) 

WRITE (6,503) ( ( PH I ( I , N , J ) , I = 1 , 6 ) , J = 1 , MSTOTL ) 

66 CONTINUE 

WRITE (6,510) 

GO TO 22 ' ’ 

65 I F ( I8K.NE.3) GO TO 69 

WRITE (3) ( (KHH( I, J) ,1=1, MSTOTL), J=l. MSTOTL) 

WRITE (6,506) 

WRITE (6,503) ( ( KHH( I ,J) »J = 1 , MSTOTL ) , 1 = 1 .MSTOTL' ) 
WRITE (6,510) 

GO TO 22 

69 IF(IBK.NE.4) GO TO 77 

WRITE (3) ( (BHH( I, J) ,1=1, MSTOTL) ,J=1. MSTOTL) 

WRITE (6,508) 

WRITE (6,503) (( BHH ( I ,J ), J= 1 , MSTOTL ), I = 1 , MSTOTL ) 
WRITE (6,510) 

GO TO 22 

77 IF( IBK.NE .5 ) GO TO 22 , 

WRITE (3) ( (MHH( I , J ) ,1 = 1, MSTOTL), J=l» MSTOTL) 

WRITE (6,509) 

WRITE (6,503) < ( MHH ( I , J ) , J= 1 , MSTOTL ) . I = 1 ,M STOTL > 
WRITE (6,510) 

22 CONTINUE 

DATA READY FOR DISCOS PROCESSING 
CALL OISCOS< I GR ID, N JO I NT, MSTOTL, ITAPE » LECHO ) 

CALL NR0D2 ( IGRID.NJOINT, MSTOTL, ITAPE , LECHO, HINGE ) 

I F ( ITAPE. LE. 6) GO TO 1 

STOP 

END 


SUBROUTINE DISCOS( IGRID,NJ,NM, ICNT, LECHO) > 

IMPLICIT REAL*8 ( A-H ,OtZ F 

c : .• • • • ; ■ 

LOGICAL LECHO 

C (!' i r # |. *.■'.< i i co?,At art, 9V. 

REAL*8 X ( 500 ) , Y ( 500) ,Z ( 500 ) , INERT A ( 6 , 6 , 500 ) ,. I RUNNO ; 

REALMS PHI ( 6,500, 12 ).,KHH( 12 , 12 ) , RHH( 12, 12) ,L0C(6 I 
REAL*8 AMS(6) ,JMASS( 500 ,1 ) ,JINER(500,6) ,AIN( 6), SMM ( 6 ),. • 

REAL *8 SMSM( 500, 3 ) , LOC A ( 500 , 3 ) , M00< 6, 6 ) , AMD ( 500, 1 3 ) , KH ( 6 ) , BH ( 6 ) 

REAL*8 AMP( 500,72 ) 

COMMON /WORK/ AMP 
EQUIVALENCE ( AMP ( 1 , 1 ) , X ( I ) ) 

EQUIVALENCE ( AMP ( 1 , 2 j , Y ( 1 ) ) 

EQUIVALENCE ( AMP ( 1 , 3 ) , Z ( 1 ) ) 
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EQUIVALENCE 

EQUIVALENCE 


{ AMP ( 1,4) , INERTA (1,1,1)) 
( AMP( 1 ,1 ) ,PHI ( 1, 1, 1 ) ) 


INTEGER I GR I D ( 500 ) 


COMMON /W0RK2/ AMO 
EQUIVALENCE ( AM0( 1,1) , JMASS( 1 , 1 ) ) , 
EQUIVALENCE ( AMD (1,7) ,SMSM( 1 , 1 ) ) , 
EQUIVALENCE ( AMD ( 1 , 1 3 ) , KHH( 1,1)), 


( AMD ( 1, 1 ) , JINER (1,1)) 
( AMD ( 1, 10 ) , LOC A (1,1) ) 
(AMD(145,13)»BHH(1,1)) 


DATA 

DATA 

* 

DATA 

DATA 

* 

DATA 

* 

DATA 
* ■ 
DATA 


* 

* 

* 

* 

* 


DATA 

DATA 

DATA 


IFST/O/ 

•••• AMS/6H JMASS l,6HJMASS2*6HJMASS3*fcHJMASS4,6HJMASS5,- - 
6HJMASS6/ 

FLX/6HFLXDAT / 

AIN/6HINERT1, 6H I NERT 2 , 6H I NE RT 3 , 6H I NE R T4 , 6H INERTS, 
6HINERT6/ 

SMM/6HSTMSM1 , 6HSTMSM2 , 6HSTMSM3 , 6HSTSMS4, 6HSTMSM5 , . 

6HSTMSM6/ . < 

L0C/6HL0CAT1 , 6HL0C AT2 , 6HL0CAT3 , 6HL0C AT4 , 6HL0C AT 5 , 
6HL0C AT 6/ 

M0D/6HXDI SI , 6H YD I S 1 ,6HZDIS1 , 6HTHA 1 1 ,6HTHA21. ,6HTHA31 

6HXDIS2 , 6HYD I S2 ,6HZDIS2 ,6HTHA12 ,6HTHA22 ,6HTHA32 

6HXDIS3 , 6H YD I S3 ,6HZDIS3 , 6HTHA 1 3 ,6HTHA23 ,6HTHA33 

6HXDIS4 , 6HYD I S4 ,6HZDIS4 , 6HTHA 14 ,6HTHA24 ,6HTHA34 

6HXDIS5 , 6H YD I S5 ,6HZDIS5 , 6HTHA 1 5 ,6HTHA25 ,6HTHA35 

6HXDIS6 , 6HYD I S6 ,6HZDIS6 ,6HTHA16 ,6HTHA26 ,6HTHA36 

KH/6HKHH1 , 6HKHH2 , 6HKHH3 , 6HKHH4 , 6HKHH5 , 6HKHH6 

BH/6HBHH 1 , 6HBHH2 ,6HBHH3 , 6HBHH4 , 6HBHH5 , 6HBHH6 

IRUNN0/6HPREPRS/ 


700 FORMAT (A6,‘ C 

INITIALIZE 

REWIND 3 

I F ( IFST.NE.O) GO TO 
CALL INTAPE ( 2 , FLX ) 
ICNT = 0 
I FST = 1 
1 CONTINUE 

ICNT = ICNT+1 
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TAPE, START COUNTER 


PROCESS MASS MATRIX DATA 

READ (3) ((( INERTA(I,J,N),I=1,6),J=1,6),N=1,NJ) 

READ (3) ( X(N) ,Y(N) ,Z(N) »N=1,NJ) 

DO 2 1=1, NJ 

IF( INERTA( 1,1, I ) .NE .INERTAI 2,2, I ) ) GO TO 3 
I F ( I NERTA ( 2 , 2 , I ) . NE . I NERT A ( 3 , 3, I ) ) GO TO 3 - — 

IF( INERTA(3,3, I ) ,LT ,0) GO TO 3 
JMASS (1,1) = I NERTA (3,3,1 ) 

GO TO 2 ' ' " 

3 WRITE ( 6, 500 I I , ( I NERT A ( 1 1 , 1 1 , I) , I I = 1 , 3 ) 

500 FORMAT (• ERROR MASS MATRIX POINT ',15,' JMASS =',3E20.10) 

JMASS ( 1,1) = ( INERTA( 1,1, I )+INERTA(2,2, I )+INERTA( 3,3, I ) )/3. ODO 
2 CONTINUE 

PUNCH READ MATRIX INPUT CARD 
PUT MASS MATRIX ON TAPE 
WR I TE ( 7, 700 ) AMS ( ICNT ) 

IF(LECHO) CALL WRITE! jMASS,NJ,l,AMS(ICNT),500) 

CALL WTAPE( JMASS, NJ^1,AMS( ICNT), 500, 2) 
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c 


PROCESS INERTIA DYAD DATA 


DO 4 1=1, NJ 

J I NER (1,1) = INERT A ( 4 , 4 , I ) 

J INER (1,2) = INERTAI 5,5, I ) 

• 'JINERI 1,3) = I NERT A I 6 , ft , I ) 

J INER (1*4) =- I NE RT A ( 4 , 5 , I ) 

J I NER (1,5) =- I NERT A ( 4 , 6 , I ) 

4 J INER (1*6) =-INERTA< 5,6, I ) 

WR I TE ( 7, 700 ) A I N ( ICNT) 

I F ( LECHO ) CALL WRITE ( JINER.NJ, ft, AINI ICNT ) ,500) 
CALL WTAPE(JINER,NJ,6,AIN( ICNT 1,500,2 ) 

PROCESS STATIC MASS MOMENT DATA 
PROCESS JOINT LOCATION DATA 

DO 5 1=1, NJ 

SMSM (1,1) = INERTAI 2,6, I ) 

SMSMI 1,2) = -INERTAI 1,6,1) 

SMSM I 1,3) = INERTAI 1,5, I > 

LOCAI 1,1) = XII) 

LOCAI I ,2) = VII) 

5 LOCAI 1,3) = Z I I ) 

WR I TE I 7 , 700 ) SMMIICNT) 

IFILECHO) CALL WRITEISMSM ,NJ,3,SMM< ICNT ) ,500) 
CALL WTAPE I SMSM ,NJ ,3 ,SMM ( ICNT), 500, 2) 

WR I TE I 7, 700. ) LOCI ICNT) 

IFILECHO) CALL WRITEILOCA ,N J , 3 , LOC I ICNT > , 500 > 
CALL WT APE I LOC A, NJ, 3, LOCI ICNT ) ,500,2 ) 

PROCESS MOOAL DATA 

READ (3) ( I (PHI! I,N,J), 1 = 1,6), J=1,NM),N=1,NJ) 
DO 6 K = 1 , 6 
DO 7 1=1, NJ 
DO 7 M= 1 , NM 

7 AMD! I , M ) = PHI (K, I ,M ) 

WRITE I 7, 700) MOD IK, ICNT) 

IFILECHO) CALL WRITE(AMO,NJ,NM,MOD(K, ICNT) ,500) 
CALL WTAPEI AMO, NJ,NM,M00IK, ICNT ) ,500,2 ) 

6 CONTINUE 

MODAL MATRICES 

READ (3) I (KHHI I , J) , 1=1 ,NM) , J=1 ,NM) 

READ (3) I (BHHI I , J ) , I = 1 , NM > , J = 1 , NM ) 

WR I TE I 7, 700 ) KHI ICNT) 

IFILECHO) CALL WR I TE I KHH ,NM ,NM , KH ( ICNT ) , 1 2 ) 

CALL WTAPEIKHH, NM,NM, KHI ICNT) ,12,2 ) 

WRITE (7,700 ) BH( ICNT ) 

WRITE 1 6, 100) ■ ' ' " ' 

IFILECHO) CALL WR I T E I BHH , NM , NM , BH I I CNT ) , 1 2 ) 

CALL WTAPEI BHH, NM,NM, BHI ICNT ), 12,? ) 

CALL LTAPEI 2) 

CALL R TAPE I IRUNNO,AMS< ICNT ) , AMD , N J , 1 , 500 , 12,2) 
CALL WRITE! AMD, NJ, 1 , AMS I ICNT ) ,500 ) 

CALL RTAPE I IRUNNO,A INI ICNT ) , AMD , N J , 6 , 500 , 1 2 , 2 ) 
CALL WRITE! AMD,NJ,6,A INI ICNT ) ,500) 

CALL RTAPE I IRUNNO,SMM< ICNT) , AMD , N J , 3 , 500, 12,2) 
CALL WRITE! AMD, NJ, 3, S MM ( ICNT ) ,500) 

CALL RTAPE! IRUNNO.LOCI ICNT ) , AMD , N J , 3 , 500 , 12,2) 
CALL WRITE! AMD, NJ, 3, LOC I ICNT) ,500) 

DO 8 K= 1,6 
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CALL RT APE ( I RUNNO, MOD < K , I CNT ) , AMO, N J,, NM , 500 , 12 , 2 ) 

8 CALL WRITE( AMD,NJ,NM,MOD(K, ICNT) ,500) 

CALL RTAPE< IRUNNO,KH< ICNT ) ,KHH,NM,NM, 12, 12, 2 > 

CALL WRITE(KHH,NM,NM,KH( ICNT), 12) 

CALL RTAPE< IRUNNO,BH< ICNT) ,BHH,NM,NM,12,12,2) 

CALL WRITE(BHH,NM,NM,BH< ICNT), 12) 

100 FORMAT (• 1 • ,5X , ******* PROCESSED LUMPED PARAMETER AND MODAL DATA N 
*0W ON DATA SET 2 (DISCOS INPUT TAPE) *****$',///) • 

RETURN ■ - 

ENO 


SUBROUTINE NB0D2 ( IGR I D ,N J , NM , I CNT , L ECHO , H I NOE ) 

C COMPUTE RESULTANT MODE DEPENDENT PARAMETERS FOR N-B0D2 

IMPLICIT REAL*8 <A-H,0-Z) 

C ; 

LOGICAL LECHO 

C 

COMMON /WORK/ AMP 
REAL *8. AMP< 500, 7 2 ) 

COMMON /W0RK2/ AMD 
RE AL*8 AMD( 500, 13 ) 

C 

REAL*8 AMS ( 6 ) , F LX , A I N ( b ) , SMM ( 6 ) ,LOC ( 6 ) , MOD ( 6 , 6 ) , KH ( 6 ) , BH( 6 ) 

RE AL*8 JMASS ( 500 ) , JL0C(3,500), CMLOC ( 3 ) * J I NER T ( 3 , 3 , 500 ) , 

* PH I T ( 3 , 500 ,12), PH I R ( 3 , 500 ,12), SM0(3,500), 

* F LOM (12), ZETA ( 1 2 ) , BDINER<3,3), 

* FLA( 3,12), F L B ( 3 , 1 2 ) , FLC(3,12), FLD( 3, 3, 12 ) , 

* FL J (3,3,12), . • • 

* FCF( 3,3,12,12 ) , FCK ( 3 » 12, 12), 

* T E M ( 3 ) , TEM 1 ( 3 , 3 ) , ADM ( 500 , 1 2 , 6 ) , TFM ( 3 ) , 

* KHH (12,12), BHH (12,12), IRUNNO f ■ . - 

INTEGER I GR I D ( 500 ) 

INTEGER HINGE, INTH 
C . 

■ DATA AMS/8HJMASS1 , f>H JM AS S2 , 8H JM ASS 3 , 6H JM ASS4 , 6H JMA SS 5 , . 

* BHJMASS6/ - 

DATA AIN/6HINERT1,6HINERT2,6HINERT3,HHINERT4,6HINERT5, 

* 6H I NERT6/ ... 

DATA SMM/6HSTMSM1, 6H STMS M2 , 6HS TMSM3 , 6HSTSMS4 , (SHS-TMSM 5 , 

* 6HSTMSMH/ 

DATA L0C/6HL0CAT1 , 6HL0C A T 2 , 6HL0C AT 3 , 6HL OC AT4 j, 6HL OC AT 5 , 

* 6HL0CAT6/ > c-v/ = «... irij 

DATA M0D/6HXD I S 1 ,6HYDIS1 ,6HZDIS1 ,6HTHA11 ,6HTHA21 ,6HTHA31 , ’ 

* 6HXDIS2 , 6 H Y 0 I S 2 » BH Z D I S2 , feHTH A 1 2 ' , 6HTHA22 » 6HT HA 32 , ■" 

* 6HXDIS3 , 6H YD I S3 ,6HZDIS3 , 6HT H A 1 3 ,iSHTHA23 ,6HTHA33 , j 

* 6HXDIS4 , 6HY0 ISA ,6HZDIS4 .,6HTHA14 .,6HTHA24 ,6HTHA34 , 

* 6HXDIS5 , 6H YD I S 5 ,6HZDIS5 ,6HTHA15 ,6HTHA25' ,6HTHA35 , 

* 6HXDIS6 ,6HYPIS6 ,6HZDIS6 , 6H TH A 1 6 ,6HTHA26 , BHT HA36 / 

DATA KH/6HKHH1 , 6HKHH2 , BHKHH3 , BHKHH4 , 6HKHH5 , 6HKHH6 / 

DATA BH/6HBHH1 , 6HBHH2 ,6HBHH3 , 6H BHH4 , 6HBHH5 , 6HB HH6 / 

DATA IRUNN0/6HPREPRS/ 

C 

EQUIVALENCE (AMP(1, 1 ) , PH I T ( 1 , 1 , 1 ) ) , ( AMP ( 1 , 37 ) , PH I R ( 1 , 1 , 1 ) ) , 

* ( AMP ( 1 , 1 ) , ADM (1,1,1)), 

* ( AMP ( 1,13) , ADM ( 1,1,2)), 
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* (AMP! 1 ,25) , ADM ( 1,1,3)), 

* ( AMP< 1,37 ) ,ADM( 1 , 1,4 )) , . - " 

* I AMP I 1 ,49) , ADM I 1,1,5 ) ) , 

* I AMP'I 1,61 ) ,ADM( 1 ,1 ,6) ) 

EQUIVALENCE ( AMD! 1 , 1 ) , JMASS ( 1 ) ) , ( AMD! 1 ,2) , JLOC! 1 , 1 ) ) , 

* { AMD I 1,5), SMO (1,1)), ( AMD( 1 ,5 ) , JINERTt 1,1, 1 ) ) 

FIND INTERNAL NASTRAN NUMBER ASSOCIATED 
WITH THE HINGE POINT (GRID POINT 'HINGE') 

DO 1 N= 1 , N J 

IF( I GRIDIN) .EO. HINGE ) GO TO 2 

1 CONTINUE 

WR I TE ( 6 , 100 ) HINGE 
RETURN 

2 INTH = N 

INTH = INTERNAL NASTRAN NUMBER 
• ' ' OF HINGE POINT 

• • * « . i 

GET DATA OFF OF TAPE 2 TO COMPUTE CENTER OF MASS 

CALL RTAPEI IRUNNO,LOC ( ICNT) , AMP, NJ, 3, 500, 7 2, 2 ) 

JLOC ( I , N ) = I-TH COORDINATE OF GRID POINT IGRID(N) ’’ 
VECTOR RELATIVE TO HINGE POINT HINGE 

DO 3 N= 1 , N J 
DO 3 1=1,3 

JLOC ( I , N ) = AMPIN, I).- AMP ( INTH* I ) 

3 CONTINUE 

CALL RTAPEI I RUNNO, AMS I ICNt ), AMP, NJ, 1,500,72, 2 ) 

JMASS I N ) = LUMPED MASS AT GRID POINT IGRIDIN) 

DO 4 N= 1 , N J 
JMASS! N ) = AMPIN, 1 ) 

4 CONTINUE 

IF| .NOT.LECHO) GO TO 17 
WR ITE ( 6, 101 ) 

WRITE I 6, 102) IN, IGRIDIN ),N, I JLOC I I , N ) , I = 1 , 3 ) , N , JMA SS I N ) , N = 1 , N J ) 
17 CONTINUE 

COMPUTE CENTER OF MASS LOCATION 
TOTMAS = 0.0 
CMLOC(l) = 0.0 
CML0CI2) = 0.0 
CML0CI3) = 0.0 

READ GRID POINT INERTIA TENSORS AND MASS’ MOMENTS 

; t i y , l t ■ i • » j * i • ) > c < ' j ' r r ; C i * ‘ I l At*in *• 

CALL RTAPE! IRUNNO,SMMI ICNT ) , AM P,NJ, 3, 500,72,2 ) 

DO 11 N= 1 * N J ; 
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DO 11 1=1,3 
SMOII,N> = AMPIN, I ) 

IFISMOI I,N).EQ.O.O) GO TO 11 
WR I TE I 6, 107 ) I N, I SMO ( I, N), 1 = 1,3) ) 

11 CONTINUE 

IFILECHO) CALL WR ITE < SMO, 3 ,N J ,6H SMO ,3) 

C 

CALL RTAPEI IRUNNO, A IN ( ICNT ) , AMP, N J, 6, 500, 72 , 2 ) 
DO 10 N=1 ,NJ 

JINERTI 1, 1,N) = AMPIN, 1) 

J INERT ( 1 , 2 ,N ) = -AMPIN, 4) 

JINERTI 1,3,N) = -AMPIN, 5) 

J INERT I 2 , 1 ,N ) = -AMPIN, A) 

JINERTI 2,2, N) = AMPIN, 2) 

JINERTI 2,3, N) = -AMPIN, 6) 

J INERT (3, 1 , N ) = -AMPIN, 5) 

JINERT(3,2,N) = -AMPIN, 6) 

J I NERT I 3 , 3,N ) = AMPIN, 3) 

10 CONTINUE 

I.F I LECHO ) CALL WR I TE I J I NERT , 9 ,N J, 6H J INERT , 9 ) 


COMPUTE UNOEFORMEO BOOY INERTIA TENSOR 
RELATIVE TO BOOY CENTER OF MASS 

DO 20 1=1,3 
DO 20 J= 1 , 3 
20 BDINERI I , J ) = 0.0 
00 19 N= I , N J 

CALL VECSUBI JLOCI 1,N) ,CMLOC,TEM) 

CALL SUEOPITEM,TEM, JMASSIN) ,TEM1 ) 
call 0YADD(BDINER,TEM1 ,BOINER ) 

CALL DYADD I BDINER, JINERTI L,I ,N ),B01NER ) 
19 CONTINUE 


READ IN MODE SHAPES AND RESORT THEM 
DO 6 1=1,6 

CALL RTAPEI IRUNNO, MOD I 1 , ICNT ) , ADM I 1 , 1 , I ) , N J , NM , 500, 12 , 2 ) 

6 CONTINUE 
REWIND 3 

WRITE (3) (I I ADMIN, M, I ) , 1 = 1,3 ) ,N=1 ,NJ ) ,M = 1,NM) 

WRITE (3) I I I ADMIN, M , I ) , 1=4,6) ,N = 1 ,NJ> ,M=1„,NM) 

REWIND 3 

READ 13) I I IPHITI I ,N,M ) , I = 1 , 3 ) , N = 1 . N J > ,M=U , NM ) 

READ (3) I(«PHIR(I,N,M),I = l,3),N=l,NJ),M='l 1 , NM) 

REWIND 3 

I F I .NOT. LECHO) GO TO 18 
WRITE I 6, 104) 

DO 7 M=1,NM 

WRITE I 6,105) , 

WRITE!6,106) I N , M , I PH I T I I ,N , M ) , I = 1 , 3 ) , 

* N,M, I PHIRI I ,N,M ) , 1=1,3) ,N=1,NJ) 

7 CONTINUE 
IB CONTINUE 

WRITE(6,11B) 
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WRITE!*, 103) TOTMAS 
WRITE(6,li5) 

WRITE (*,119). (RDINER(1»J)»J=T»3) 

WRITE!*, 120) !BDINER!2,J),J=1,3) 

WRITE!*, 121 ) (BDINER(3,J),J=1,3> 

WRITE!*, 115) 

WRITE!*, 122.) (CMLOCd ), 1=1,3) 

WRITE!*, 115) 

WRITE' (*,125) INTH, HINGE 
WRITE (*,115) 

COMPUTE RESULTANT PARAMETERS 

DO 8 M= 1 , NM 
DO 8 1=1,3 
FLA! I , M ) = 0.0 
FLB ( I,M) = 0.0 
FLC! I ,M) = 0.0 
DO 8 J= 1 , 3 

FLJI 1 * J,M) = 0.0 - 

FLO! I , J,M) = 0.0 

8 CONTINUE 
DO 9 M= 1 , NM 
DO 9 MM = 1 , NM 
DO 9 1=1*3 
FCK ( I , M , MM ) = 0.0 
DO 9 Jr 1 1 3 
FCF ( I, J,M,MM) = 0.0 

9 CONTINUE 
C 

c 

AMASS = l.O/TOTMAS 
C 

DO 12 M= 1 , NM 
DO 13 J= 1 , N J 
C 

CALL SCLV! JMASS! J) , PHI T ( 1 , J ,M ) , TEM ) 

CALL VECADD(FLA(1,M),TEM,FLA(1,M) ) 

C 

CALL VECSUB! JLOC! 1, J) ,CMLOC,TEM) 

CALL SUEOP! PHIT! 1 ,J . M ) ,TEM , JMASS ( J ), TEM 1 ) 

CALL 0YADD(FLD(1,1,M),TEM1,FLD(1,1,M) ) 

C ' 

CALL VECROS! JLOC! 1,J), PHIT! 1,J,M), TEM) 

CALL SCLV! JMASS! J) , TEM, TEM) 

CALL VECADD! FLB! 1 , M ) , TEM , FLB ( 1 , M ) ) 

C ' 

I F ( JINERT ( 1 , 1 , J ) . EQ.P.O. AND. . 

JINEPT! 2,2, J ) .EO.O.O. AND. 

* JINERT(3, 3, J). EO.O.O) GO TO 13 
C ‘ 

CALL DYDOTV! JINERT! 1 , 1 , J ) , PH I R ( 1 , J , M ) , TEM ) 

CALL VECADD!. FLC! 1,M) , TEM, FLC ( 1 , M ) ) 

c ■ • ■ 

CALL VECXDY ( PH I R ( 1 ,J,M)., JINERT ( 1 , 1 , J ) , TEM 1 ) 

CALL D Y A DD ( F L J ( i » 1 , M ) , T.E M 1 , F L J ( 1 , 1 * M ) ) 

13 CONTINUE 

C ' ' 

C RESULTANT, UNCOUPLED MODE DEPENDED PARAMETERS 



nnn oooooo 


CALL SCLV( AMASS, FLA ( 1,M) , FLA ( 1,M) ) 
CALL SCLV< AMASS, FLR( l ,M ) , FLR ( 1 , M ) ) 
12 CONTINUE 


READ MODAL STIFFNESS AND DAMP INC DATA 

CALL RTAPEI IRUNNO,KH( ICNT ) ,KHH,NM,NM, 12, 12,2) 

CALL R TAPE < IRUNNO,BH( I CNT ) , BHH, NM , NM, i 2 , 1 2 , 2 ) 

DO 16 M= 1 f'NM 
WRITE (6,116) M 

FLOM(M). = DSORT ( KHH ( M , M ) ) , ' 

ZETA(M) = BHH(M,M)/(2.0*FL0M(M) ) 

WRITE ( 6, 115 ) 

WR ITE(6,123) M , FLOM ( M ) 

WRITE ( 6,115) 

WR I TE ( 6 , 124 ) M , ZET A ( M ) 

WR I "TE ( 6, 1 1 5 ) 

WRITE(6,108) (M, ( FLA( I ,M) , 1 = 1,3 ) ) 

WRITE (6, 115) 

WR I TE ( 6 , 109 ) (M, (FLB(I ,M) ,1=1,3) ) 

WRITE (6, 115) 

WR ITE(6,ilO) (M,(FLC(I,M),I=1,3)) 

WRITE(6*115) 

WRITE(6, 126) (M, ( FLO ( 1,J,M) ,J=1,3) ) 

WR I TE ( 6, 1 1 1 ) (M, ( FLD( I ,.),M) , J = 1 ,3 ), 1=2,3) 

WR I TE ( 6 , 1 1 5 ) 

WRITE(6,127) (M,(FLJ( 1 ,'J , M ) , J = 1 , 3 ) ) 

WRITE (6, 112) ( M , ( F L J ( I,J,M),J = 1,3)» 1=2,3) 

WRITE (6, 115) 

16 CONTINUE 

WRITE (6,105) 

RESULTANT COUPLEO MOOE DEPENDENT PARAMETERS 

DO 14 NN=1 ,NM 
DO 14 MM= 1 , NM 

DO 15 J= 1 ,NJ 

CALL SUEOP ( PH I T ( 1 , J , NN ) , PH I T ( 1 , J , MM ) , JMASS ( J ) , TEM1) 
CALL DYADD( FCF ( 1 , 1 ,MM,NN ) ,TEM1 ,FCF( 1 , 1 , MM , NN ) ) 

CALL DYDOTVI J INERT ( 1 , 1 , J ) , PH I R ( 1 , J , MM ) , T EM ) 

CALL VECR0S(TEM,PHIR(1,J,NN),TFM) 

HF = .5. 

CALL SCLV( HF, TFM, TEM ) 

CALL VECROSI PHIR ( 1 , J,MM ) ,PHIR ( 1 , 1 ,NN ) , TFM ) 

CALL SCLV( JMASS(.)),TFM,TFM) 

CALL' VEC ADD (TEM, TFM, TEM) 

CALL VECADD(FCK( 1 ,MM,NN ) ,TEM,FCK( 1 ,MM,NN) ) 

15 CONTINUE ... 

WRITE * (6,117) MM , NN 
WRITE (6, 115) 

WRITE (6, 128 ) (MM,NN, ( FCF ( 1 , J,MM,NN) , J=1 ,3 ) ) 

WRITE (6, 113) (MM,NN, (FCF ( I , J , MM , NN ) , J=T, 3 ) ,1=2 , 3 > 

WRITE(6, 115) 

WR ITE(6,114) (MM,NN, ( FCK ( I ,MM,NN) , 1 = 1 ,3 ) ) 

14 CONTINUE 


B-22 



100 FORMAT (IX, • ** ERROR ** CANNOT FIND HINGE POINT', 15,' IN GRID P 

*0 1 NT TABLE, RETURN OUT OF SUBROUTINE NROD? ' ) ‘ 

101 FORMAT (////,' GRIO POINT LABELING, LOCATION AND MASS TABLES',//) 
10? FORMAT- (• I GRID! ',14*' ) = • , 1 5 ,9X , < JLOC ( ' , 14 , ' ) = ' , 3E 1 5 . 7 , 9 X , 

* • JMASSt • , 14, • ) = ' , E 1 5 . 7 ) 

5 CONT INUE 

A = 1.0/TOTMAS 

CALL SCLVI A , CMLO'C ,CMLOC ) 

DO 5 N= 1 , N J 

TOTMAS = TOTMAS + JMASS(N) _ 

CALL SCLV(JMASSIN) , JLOC ( 1 ,N ) , TEM ) 

CALL V£CADD(CMLOC,TEM,CMLOC ) ‘ ‘ . 

« Yi i ) = x< i+i v ’ : 

NY = 3 . 

NR = I Y ( 3 ) 

RETURN 

7 I F ( IF0RM.NE.307) GO TO 9 
I Y < 1 ) = NR + 1 

yi i i = xm 

NY = 1 • • '* 

nr = Xf 2)*FAC ' •'••••* • 

IF(NR.EO.O) RETURN • ; 

I Y( 2) = NR • ' ; ' 

Y ( 2 ) = X ( 3 ) '■ - 

: NY.. = 2 

NR = X(4)*FAC ' ' ' ' ■ ; ' • ‘ 

IF(NR.EO.O) RETURN 
NR * NR-1 

RETURN " •• ' ‘ - 

9 I F ( I FORM . NE . 308 ) GO TO 10 / ' ' ' 

NR = XI1KFAC •• . ’ 

IF(NR.EO.O) GO TO 14 , 

DO 11 1=1,3 , . , ‘ ' “ 1 . 

I Y ( I ) = NR- 1 + I 
1 1 Y (!) = X ( I + 1 ) 

NY = 3 . , 

NR = I Y ( 3 ) • • 

RETURN 

10 I F ( 1F0RM.NE.309) GO TO 12 

NR a X ( 1 )*FAC . • 

IF(NR;EO.O) GO TO 14 
DO. 13 1=1,2 
I Y ( I ) = NR-1 + I 
13 Ylil = XII+1) 

NY = 2 

NR - = X ( 4 ) *F AC 
IF(NR.EO.O) RETURN 
NR = NR-1 
RETURN 

103 FORMAT (• XMAS = • , E 1 5 . 7 , 30X , • (TOTAL MASS OF BODY)',) 

104 FORMAT (.////,' MODE SHAPE TABLE (INTERNAL NUMBERING) •',//) 

105 FORMAT (///) 

106 FORMAT ('. PHIT( 14, 12, ' ) = ' , 3E 15 . 7 , 5 X ,. 

PHIR( 1.4, • , • , 12, ' ) =' , 3E1 5 . 7 ) 

107 FORMAT (///,» WARNING MASS MOMENT AT GRID POINT NON-ZERO, THAT IS 
*’ SMM *iI4, •) =•, 3E15.7,/,' THIS EFFECT IGNORED BY N-B0D2. N-B0D2 
*. ASSUMES EACH GRID' POINT AT ELEMENT MASS CENTER ') 


108 FORMAT <• FLA(',I2,') = ',3615.7,* (COEFFICIENT TO FIND CENTER OF 

♦ MASS LOCATION AFTER DEFORMATION)') 

109 FORMAT (• FLB(',I2,«) = ',3E15.7,' (COEFFICIENT TO FIND ANGULAR M 

MOMENTUM. DUE TO DEFORMATION)') .... 

110 FORMAT (' FLC ( ' ,12, • ) = ',3615.7, ' (COEFFICIENT TO FIND' ANGULAR M 
♦OMENTUM DUE TO DEFORMATION)') 

111 FORMAT (• FL0( ' , 12, * ) = *,3E15.7) 

112 FORMAT (• FL J ( ' , 1 2, ' ) = «,3E15.7) ^ , 

113 FORMAT (• FCF(',I2,','»12,')- =',3E15.7) 

114 FORMAT (• FCK( • ,12, ', • , 12, ' ) =',3E15.7,' (COEFFICIENT FOR CORIOLI 

♦ S TOROUE DUE TO DEFORMATION)') 

115 FORMAT ( • • ) 

116 FORMAT (/v3X,'F0R MODE ',13,' THE RESULTANT UNCOUPLED MODE OEPENDEN 
♦T PARAMETERS REQUIRED FOR N-B0D2 INPUT ARE') 

117 FORMAT ( / * 3 X * •' FOR MODES', 13, \ AND', 13,' THE RESULTANT MODE DEPENDS 
♦NT CROSS COUPLING: PARAMETERS REQUIRED FOR N-R0D2 INPUT ARE'.) 

118 FORMAT (• 1 '.,5X, •♦♦♦♦♦ RESULTANT FLEXIBLE BODY DATA REQUIRED FOR IN 
♦PUT TO N-B0D2 ♦♦*♦ 41 ,///) 

119 FORMAT (• • ' , 3E 1 5 . 7 , • (UNDEFORMED INERTIA TENSOR OF THE') 

120 FORMAT (• XI =' »3E15.7, ' FLEXIRLE BODY IN BODY COORDINATES') 

121 FORMAT (' ',3615.7,' RELATIVE TO BODY CENTER OF MASS)') 

122 FORMAT (• CA ='V3E15.7,' (CENTER OF MASS VECTOR, HINGE POINT T 
♦0 CM) • ) 

123 FORMAT (• FLOM ( ',12,') =',E15.7,' RAD/SEC (MODAL FREQUENCY)') 

124 FORMAT (• ' ZETA (',12,') =',E15.7,' (MODAL DAMP I NG • ZETA ) • ') 

125 FORMAT (• CB = VECTOR IN CONTIGUOUS BODY TO H I NGE PO I NT DE F I NED 

♦ AT INTERNAL GRID POINT', 15,' (EXTERNAL GRID POINT', 15,' IN BULK D 
♦ATA)') 

126 FORMAT (• FLD( ' , 12 , ' ) = S3E15.7,' (COEFFICIENT TO FIND INERTIA T 
♦ENSOR AFTER DEFORMATION)') 

127 FORMAT (• FLJC.I2,') = ',3E15.7,' (COEFFICIENT FOR CENTRIPITAL T 
♦ORQUE DUE TO DEFORMATION) ' ) 

128 FORMAT (' FCF( • , 12, • , • , 12, ' ) =',3E15.7,' (COEFFICIENT FOR CENT.RIP 
♦ I TAL TOROUE DUE TO DEFORMATION)') 

RETURN 

END 


SUBROUTINE INTERPI INPT , IMAT ) 

C 

C THIS ROUTINE SETS UP A CODE SEQUENCE WHICH WILL HE USED 

C TO READ MIXED INTEGER ANO FLOATING POINT DATA FROM 

C THE DMI CARDS 

C RLANK FIELD ON LAST CARD WILL BE INTERPRETED AS AN INTEGER 

C BUT READ LATER IN AS ZERO, A CHECK FOR WHICH IS MADE 

C 

INTEGER INPT ( 80 ) 

DATA I DOT , IEE/1H. , 1HE/ 

I F ( INPT ( 12). .EQ. I DOT .AND. INPT (21 J.EQ.IEE) GO TO 1 
I F ( INPT(44) . EO. IOOT. AND. INPT ( 53 ) . EQ. I EE ) GO TO 2 
IMAT > 310 

C 310 - FORMAT I , E , I , E .... 

RETURN 

2 IF( INP.T(60) .EQ. IOOT. AND. INPT (69 ) .EQ.IEE ) GO TO 3 
IMAT = 309 

C 309 - FORMAT I , E , E , I 
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. RETURN . 



3 

IMAT = 

308 


■ - - 



c 


RETURN 

308 - FORMAT 

• 1 ’ 

E , E * E 




1 

IF ( 1 NPT (28) .EO. IDOT . AND. 1NPT ( 37 ) .EO. 

I EE ) 

GO TO 

4 ’ 




I F ( INPTt 60) .EO. I DOT. AND. I NPT (69) .EQ. 

I EE ) 

GO TO-. 

5 




IMAT = 

307 




* . *; 

c 


RETURN 

307 - FORMAT 

'■ E, 

I,E, If 

OR 

e *; 


5 

IMAT = 

306 

, 




c ' 


RETURN 

306 - FORMAT 

, E, 

I ,E,E: " 

■' ; : 

• * i • • i 


4 

IF ( INPT ( 44.) .-EO, IDOT. AND. I NPT ( 53 ) .EO. 

I EE ) 

GO TO 

6.. 


Vi • 

.1 

IMAT = : 

305 




J 1 ; 

c 



. 305 - FORMAT 

E, 

E V I * E. ■ 

OR 

EVE' 



RETURN; 







6 

I Ft INPT ( 60) .EO. IDOT .AND. INPT (69 ) .EO. 

I EE ) 

GO TO 

7 

; ..... 



IMAT = 

304 

, - 


5 


c 



.304 - FORMAT 

- E 

E,E,I 

OR 

m 

« 

m 

m 



RETURN 

« ' , 




. ; . * 


:/ 1 

IMAT = 

303 



• ,s • 


c 


RETURN 

303 - FORMAT 

E, 

E , E , E . 





END . 



. { 

.7' 



■ ? f ■ 


• . - > ' 



. Kw \ 



SUBROUTINE DECODE ( I FORM , X , NR ♦ Y » I Y , N Y ) '' 

C . . ■ • '■ 

C*** ERROR IN TERMINOLOGY ELEMENTS COMING IN BY ROWS, 

NR AND I Y ( I I REFER. TO COLUMN NUMBER /. H; •> ••• 

OUTPUT OF DECODE " ' V • • 

NY = NUMBER OF REAL NUMBERS ON DMI CARD • '■ •’ , U 
I Y ( I ) = ROW LOCATION FOR I-TH REAL NUMBER ON OM I CARD 
Y ( I ) = I-TH REAL NUMBER 

NR = NEXT REAL NUMBER TO RE PUT IN ROW NR+1 UNLESS 
FIELD 1 OF NEXT CARD CONTAINS AN INTEGER 

R E A L * 8 X(4), Y(4) 

INTEGER I Y ( 4 ) 

FAC ..= I.0000ID + 08 . 

IF* I FORM. NE. 303.1 GO TO ^1 , 

DO 2 1=1,4 

I Y ( I) =. NR.+ I , 

2 Y ( I ) = X C I ) ' 

NY = 4 
NR = I Y { 4 ) 

R ETURN . , ' 1 ■ ’ ; 

1 IF( IFORM.NE.304) GO TO 3 
DO 4 1=1 ,3 

i y * 1 1 = nr+i • : • 

4 Y 1 I ) = X II) 

N,Y .= 3 ' 

NR = X(4)*FAC-1 ... . 

RETURN ' ; • • 

3 IF( IF0RM.NE.305) GO TO 5 
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00 6 1 = 1,2 
IY( I) = NR+I 
6 Y ( I ) = X ( I ) 

NY = 2 

NR = X(3)*FAC 
IF(NR.EO.O) RETURN 

I Y ( 3 ) = NR 
Y ( 3 ) = X(A) 

NY = 3 
RETURN 

5 IF( IF0RM.NE.306) GO TO 7 
I Y ( 1 ) = NR+1 



NR = X(2)*FAC 
IF(NR.EO.O) RETURN 
DO 8 1=2,3 
I Y ( I) = NR-2+I 

12 IF( IF0RM.NE.310) GO TO 1A 
NR = X(1)*FAC 
IE(NR.EO.O) GO TO 1A 
I Y ( 1 ) = NR 
Y ( 1 ) = X( 2) 

NR = X ( 3 ) *F AC 
IF(NR.EO.O) RETURN 
I Y ( 2 ) = NR 
Y ( 2 ) = X ( A ) 

NY = 2 
RETURN 

1A WR I TE ( ft , 100 ) I FORM 
100 FORMAT (• I FORM =*,15,' ERROR') 
STOP 
END 


SUBROUTINE INTAPE ( NT APE , TAPE I 0 ) 
REAL*8 TAPEID,BUF,EOT 
DATA IZ1,BUF, EOT/1, O.D 0.3HE0T/ 
DATA NOT / <6/ 


INITIALIZE TAPE FOR SUBROUTINE WTAPE. 
CALLS FORMA SUBROUTINE PAGEHD. v 

CODED BY RF HRUDA. JULY 1968... 
REVISED BY R A PHILIPPUS. APRIL 1969. 


SUBROUTINE ARGUMENTS (ALL INPUT) 

NT APE = NUMBER OF TAPE. (E.G. 10). 

T APE I D = TAPE IDENTIFICATION. (E.G. T123A). ( A6 FORMAT) 


2001 FORMAT (//// 


REWIND NTAPE 
WRITE (NTAPE 
REWIND NTAPE 


1 AH LOGICAL UNIT 17, 7H, TAPE A6, 
23H, HAS BEEN INITIALIZED.) J - 

T APE ID, I Z 1 , EOT , ( BUF , I = 1, 16 ) . 



B-26 



o o on oooooooonnoooooooooooooo 


WRITE (NOT, 2001) NT APE, TAPE ID 

RETURN 

END 


SUBROUTINE WTAPE ( A ,NRA , NC A , ANAME , KR , NT APE > 

REAL*8 A, ANAME, IRUNNO, DATE, 

* BUF, EOT, DENSE, TAPE10, 1E0TCK 
DIMENSION A ( KR , 1 ) 

DATA IRUNNO, DAtE/6HPREPRS,6HDATE / 

DATA BUF, EOT, DENSE/O. D 0 , 3HE0T , 5HDENSE / 

DATA NOT / 6/ 

WRITE MATRIX A ON TAPE. 

INITIALIZE TAPE WITH SUBROUTINE INTAPE. 

REWIND TAPE BEFORE FIRST USE OF THIS SUBROUTINE. 

NOTE. ..THIS ROUTINE IS DESIGNED SPECIFICALLY FOR WRITING ON A DISK 

(EG C DC-6400 OISK). USING THIS ROUTINE TO WRITE ON A PHYSICAL 
TAPE DIRECTLY (IE WITHOUT USING THE DISK AS AN INTERMEDIARY) 
WILL PROBABLY GIVE POOR RESULTS (DUE TO THE TOLERANCE 
CHARACTERISTICS OF A TAPE DRIVE) AND SHOULD BE AVOIDED IF AT 
ALL POSSIBLE. 

...THE CDC-6400 DISK IS AUTOMATICALLY ENDFILED AFTER EACH WRITE. 
CODED BY W A BENFIELO. MARCH 1966. 

REVISED BY R A PHIL1PPUS. APRIL 1969. 

REVISED BY RF HRUOA . NOVEMBER 1970. 

SUBROUTINE ARGUMENTS (ALL INPUT) 

A = MATRIX TO BE WRITTEN ON TAPE. S I ZE ( NR A , NC A ) . 

NRA r NUMBER OF ROWS OF MATRIX A. 

NC A = NUMBER OF COLS OF MATRIX A. 

ANAME = MATRIX IDENTIFICATION. (A6 FORMAT). 

KR = ROW DIMENSION OF A IN CALLING PROGRAM. 

NT APE = NUMBER OF TAPE. (E.G. 10). 

INTERNAL VARIABLES THAT ARE PUT ON TAPE (TRANSFERRED THRU COMMON). 
IRUNNO IS RUN NUMBER OF PROBLEM. ( A6 FORMAT). 

DATE IS DATE. (A6 FORMAT). FOR EXAMPLE 15FE65. 

IF (NRA ,LT. 1 .OR. NC A .LT. 1) GO TO 999 

C SEARCH TAPE FOR END OF WR I TTEN. OAT A i 
10 READ ( NT A PE ) T APE I D , LN , I EOTCK 
IF (IEOtCK .EO. EOT) GO TO 20 
READ (NTAPE ) 

GO TO 10 
C 

C END OF WRITTEN DATA HAS BEEN FOUND. 

20 BACKSPACE NTAPE 

WRITE (NTAPE) TAPE I D, LN , BUF , I RUNNO , ANAME , NR A , NC A , D AT E , DE NSE , 

* (BUF, 1=1,10) 

WRITE (NTAPE) ( ( A ( I , J ) , I = 1 ,NR A ) , J= 1 , NC A ) 

LN = LN + 1 

WRITE (NTAPE) TAPE I D, LN , EOT , ( BUF , I = 1 , 1 6 ) 
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BACKSPACE NT APE . ' 

RETURN • V 

999 WRITE ( NOT » 1000 ) 

1000 FORMAT ( 1H1 « 43HERR0R IN SUBROUTINE WT APE * PROGRAM STOPPED;) 
STOP 
END 


SUBROUTINE IT APE ( NT APE ) 

REAL*8 TAPE ID, IRUNNO, ANAME, I EOTCK.DATE, ITYPE , ICHK, EOT’, :■ Hv ' 

* DENSE, SPARSE, SPART !; 

. DATA NOT / 6/ 

DATA EOT, DENSE.,SPARSE, SPART/ 3HE0T , 5HDENSE » 6HSP AR SE » 5HSP ART/ 

LIST HEADINGS OF MATRICES ON TAPE. 

CALLS FORMA SUBROUTINE PAGEHD. 

CODED BY RF HRUDA. JULY 1968. REVISED NOVEMBER 1970. 

REVISED BY R A PHILIPPUS. APRIL 1969. 

SUBROUTINE ARGUMENTS (ALL INPUT) 

NT APE = NUMBER OF TAPE. (E.G. 10). ■ ... 

2001 FORMAT < //36X35HL I ST 1 NG OF MATRICES ON LOGICAL UNIT 13., 7H', TAPE A6) 

2002 FORMAT ( //30X35HL ISTING OF MATRICES ON LOGICAL UNITI3,7H, TAPE A6, 

* . 12H (CONTINUED)) V- > •. 

2003 FORMAT ( 27X69 < 1 H — ) /27 X3HN0 . 3X7HRUN NO . 4X4HNAME5X5HNR0WS4X5HNC0LS4X 

* ' 4HDATE6X3HNNZ3X9HPARTITI0N/ - 

*. 27X3H 3X6H 4X6H 4X5H 

* . 4X5H 3X6H- 5X3H 3X9H / ) ' 

2004 FORMAT (25X15, 3XA6,4XA6»3XI5, 4X15,4X46, 3X15,3X14, 1H /-I 4) ' 

2005 FORMAT (/27X12HEND OF LIST.) - • f-' 

C 

REWIND NTAPE 
" 'READ' i ( NT APE ) TAPEIO 

REWIND NTAPE • ' " 

L s 0 ■ • , • f' 

c • . • . •• •- 

12 CONTINUE . 

I F ( L .EO. 0) WRITE (NOT, 2001) NTAPE, TAPEID 

I F ( L .NE. 0). WRITE (NOT, 2002) NT APE , T-APE I D ' 

WRITE (NOT, 2003) 

NUNE = 1 

13 L =L+ 1 , • : i vt' . 

READ (NTAPE) TAPE ID,LN, IEOTCK, I RUNNO , ANAME, NR, NC, 0 ATE »ITYPE‘*NNZ* ;• 

. .... 1NP,NP.T • 1 ' 

IF (L .EO. 1 ) ICHK = IRUNNO • ' 

IF ( ICHK . .EO. IRUNNO) GO TO 15 • - . = ' 

NL INE=NL INE+1 
WRITE (NOT, 2004) 

ICHK = IRUNNO 

15 IF (IEOTCK .EO. EOT) GO TO 30 ■■■•. ' . ' 

READ (NTAPE) 

IF ( I TYPE . EO. DENSE ) WRITE (NOT, 2004) 

4 ... LN, IRUNNO, ANAME, NR, NC. DATE 
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IF. ( ITYPE .EQ. DENSE ) GO TO 20 
IF (ITYPE .EQ. SPARSE) WRITE ( NOT , 2004 ) 

* LN, IRUNNO, ANAME, NR, NC, DATE, NNZ 

IF (ITYPE .EQ. SPARSE) GO TO 20 , 

IF (ITYPE .EQ. SPART ) WRITE (NOT, 2004) . v 

* LN, 1 RUNNO , ANAME , NR , NC » DATE , NNZ * NP, NPT 
IF (ITYPE .EQ. SPART ) GO TO 20 . 

WRITE (NOT, 2004) LN, I RUNNO, ANAME , NR , NC , I TYPE 
20 NL I NE=NL INE + 1 
. I F ( NL I NE . GT .43 ) GO TO 12 
GO TO 13 
C 

30 WRITE (NOT, 2004) LN, IEOTCK 

WRITE (NOT, 2005.) . . 

REWIND NTAPE 

RETURN ’ ... 

END • • 


SUBROUTINE RTAP6 ( I ARUNO , I AN AME , A,NRA,NCA» KR'* KC * NT AP E ) 0 ' * 

REAL*fl A, IARUNO, I ANAME , TAPE I D , IEOTCK, ITRUNO, ITNAME, 

* DATE, ITYPE, DENSE, EOT ' . ' 

DIMENSION A ( KR , 1 ) 

- DATA NOT / b / 

•t DATA DENSE, EOT / 5HDENSE , 3HE0T / • . 

C •. ; ■ ■ -,<-'Ty • 

C READ MATRIX A FROM TAPE BY IDENTIFICATION OF I ARUNO , I ANAME . 

C ,, C ALLS FORMA SUBROUT INES LTAPE , PAGEHD , Z'ZBOMB*’ v..; i'/ 

C CODED- RY WA BENFIELD. JUNE 19T.6. 

C LAST REVISION BY R F HRUDA. SEPTEMBER 1971. 

C ■ ' ' 

C SUBROUTINE ARGUMENTS « '• 

C IARUNO = INPUT RUN NUMBER OF MATRIX A. ( A6 FORMAT). • 

C I ANAME = INPUT MATRIX IDENTIFICATION. (Aft FORMAT). 

C A = OUTPUT MATRIX READ FROM TAPE. S I ZE ( NR A , NC A ) . ■, 

C NR A = OUTPUT NUMBER OF ROWS OF MATRIX A. WILL BE READ FROM TAPE. 

C NC A = OUTPUT NUMBER OF COLS OF MATRIX A. WILL BE READ FROM T-APE. 

C KR = INPUT ROW DIMENSION OF A IN C A L L I NG PROGR AM . 

C KC = INPUT COL DIMENSION OF A IN CALLING PROGRAM. 

C NTAPE = INPUT NUMBER OF TAPE. (E.G. 10). '' 

C •• 

3001 FORMAT ( 29H1RT APE CANNOT FIND RUNNO = A6 . / . -'i 

* 2 1 X 8HANAME = A6 / 29X 6H ) ' 

C ■ • ’ . 

NTIME = 0 * ' : 

C SEARCH TAPE FOR CORRECT HEADING. - 

5 READ (NTAPE) TAPEID,LN, IEOTCK, ITRUNO, I TN AME , NR A , NC A , DATE , I TYPE, NNZ 
IF (ITRUNO .EQ. IARUNO .AND. ITNAME .EQ. I ANAME ) GO TO 10/ 

IF (IEOTCK .EQ. EOT) GO TO 20 
READ (NTAPE ) 

GO TO 5 
C 

C MATRIX. HAS BEEN FOUNO. 

10 
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' NERROR-1 

IF (1 TYPE .NE. i DENSE .AND. NNZ .NE. 0) GO TO 999!- 

' ’ NERR0R=2 

IF (NRA.GT.KR. .OR. NCA.GT.KC) GO TO 999 

READ I NT A PE i ( { A ( I . J ) , I = 1 , NR A ) , J= 1 , NC A ) ; 

RETURN , 

MATRIX CANNOT RE FOUNO. SEARCH TAPE ONCE MORE. " 

20 NT I ME =• NT I ME + 1 ■ '■ 

. N ERR OR = 3 

IF (NT I ME .EO. 2) GO TO 99R 
REWIND NT A PE . 

■ GO TO 5 , . , - , . 

99H WRITE' (NOT, 3001 ) I ARIJNO , I AN AME 
999 CALL LTAPE (NTA.PE) 

WRITE (NOT, 3002) NERROR . ' 

3002 FORMAT. ( 1 H 1 , 43HERR0R IN SUBROUTINE RTAPE, PROGRAM STOPPED,- • ‘ 
* 10H NERROR = ,13) 

STOP 

END- 


SUBROUTINE WRITE ( A ,NR ,NC , AMAME , KR ) 

REAL*8 A , ANAME 

, DIMENSION A ( K R , 1 ) ' . 

DATA NOT / 6/ 

WRITE MATRIX OF REAL NUMBERS ON PAPER. • - 

REQUIRES 123 COLUMN (MINIMUM) PRINTER. . ' . 

UP TO 10 DATA FIELDS PER LINE. PRINTS ONLY NON-Z ERO. F.I E LD ROWS;- 
CALLS FORMA SUBROUTINE PAGEHO. ‘ 

CODED BY RL WOHLEN. DECEMBER 1968. 

SUBROUTINE ARGUMENTS (ALL INPUT) ' 

A = MATRIX TO BE PRINTED. SIZE (NR, NC ) . 

NR = NUMBER OF ROWS IN MATRIX A. 

NC = NUMBER OF COLS IN MATRIX A. - - 

ANAME = MATRIX IDENTIFICATION. (A6 FORMAT ). !; 

KR = ROW DIMENSION OF A IN CALLING PROGRAM. • / 

2010 FORMAT (//15H OUTPUT MATRIX A6,2X 1H(I4,2H X 14, 2H ) /./.. V' 

* 10X, 10 ( 7X, 1H( 1 2 , 1H ) ) / ) 

2020 FORMAT I//15H OUTPUT MATRIX A6,2X 1HLI4, 2H,X 14, 2H ) . - 

* 3X , 9HC0NT INUEO / / 10X , 1 0 ( 7 X , 1 H ( ‘ I 2 , 1 H ) ) / ) , ' ' ' •'< ' - 

2030 FORMAT ( 1 X , 2 1 5 , 2X , IP 10D1 1 .3 ) ... . 

2040 FORMAT ( 14H0END OF WRITE.) • - 

PULL UP A NEW PAGE FOR MATRIX AND PRINT MATRIX NAME^ ’ 

WRITE (NOT. 2010.1 AN AME , NR , NC , ( L , L = 1 , 1 0 ) 

NL INE. = 0 ; . 

c . 

DO 60 1=1, NR 

NZERO = 0 ‘ 

JS = 1 

10 JE = JS + 9 
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IF (JE .GT. NC) JE=NC 

C SEE IF ELEMENTS ARE ZERO. - - 

DO 20 J=JS, JE 

IF- ( A ( I « J ) .NE. O.D 0) GO TO 30 
20 CONTINUE 
GO TO 40 

30 NLINE = NLINE+1 

IF INLINE .LE. 44) GO TO 35 

WRITE (NOT, 2020) ANAME , NR , NC , ( L , L = 1 , 1 0 ) 

NLINE = 1 

35 WRITE (NOT, 2030) I , JS , I A I I , J ) , J=JS,JE> 

NZERO = 1 

40 IF ( J.E .EO. NC) GO TO 50 
JS = JS + 10 
GO TO 10 

C SKIP A SPACE BETWEEN EACH ROW IF THERE ARE MORE THAN 10 COLUMNS 
C AND SOMETHING HAS BEEN WRITTEN. 

50 I F ( NC . LE .10 .OR. NZERO. EO.O .OR. I.EO.NR) GO TO 60 
NLINE = NLINE+1 
WRITE I NOT, 2030) 

60 CONTINUE 
C 

WRITE (NOT, 2040) 

RETURN 

END 


SUBROUTINE VECADD ( V 1 , V2 , S ) 

C ADOS VECTOR VI TO V2 RESULT IN S 

IMPLICIT RE AL *8 ( A-H , 0-Z , $ > 
DIMENSION VI ( 3 ) , V2 ( 3 ) , S ( 3 ) 

S(I) = VI ( 1 ) + V2 ( 1 ) 

S.( 2 ) = V1I2I + V2 ( 2 ) 

S ( 3 ) = V 1 ( 3 ) + V 2 ( 3 ) 

RFTURN 

END 


SUBROUTINE VECSUB ( V 1 , V2 , 0 ) 
C SUBTRACTS VECTORS Vl-V2=0 

IMPLICIT REAL*8( A-H,0-Z,$ ) 
DIMENSION VI ( 3 ) , V2 ( 3 ) , D ( 3 ) 
0(1) = VI ( 1 ) - V2( 1 ) 

D ( 2 ) = VI (2 > - V2(2) 

D ( 3 > = VI ( 3) - V2 ( 3 ) 

RETURN 

END 
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SUBROUTINE SCLV(SC*V,P) 
SCALAR * VECTOR 
IMPLICIT REAL*8(A-H,0-ZtS) 
DIMENSION V ( 3 ) » P ( 3 ) ’ 

P(l) = SC*V<1) 

P(2) = SC*V ( 2 ) 

P ( 3 » = SC*V(3> 

RETURN 

ENO 


SUBROUTINE VECOOT ( V 1 , V2 . D 1 
VECTOR DOT PRODUCT 
IMPLICIT REAL*8 ( A-HtO-Z ♦ $ ) 

DIMENSION VK3) *V2(3» 

D = Vllll*V2m + V 1 ( 2 ) *V2 ( 2 ) + V1(3)*V2(3) 

RETURN 

END 


SUBROUTINE VECROS <V1,V2,C> 

VECTOR CROSS PRODUCT C = VI X V2 
IMPLICIT REAL*8(A-H,0-Z,S) 
DIMENSION VI (3) ,V2(3) ,C(3) 

C(l) = V 1 ( 2 I *V2 ( 3 ) - V1(3)*V2(2» 

C ( 2 ) = V1(3)*V2<1>- VI ( 1 ) *V2 ( 3 ) 

C ( 3 ) = V 1 ( 1 ) *V2 ( 2 )- V 1 ( 2 ) *V2 ( 1 > 

RETURN 

ENO 


SUBROUTINE TRTP VP ( VI ♦ V2 ♦ V ) 

COMPUTES STANDARD VECTOR TRIPLE PRODUCT 

V = V I X ( V 1 XV2 ) 

= VI* ( VI . V2 ) - V2*(V1.V1) 

IMPLICIT REAL*8 ( A-H ,0-Z » t ) 

DIMENSION V1(3),V2(3),V(3) 

A = V1(1)*V2(1> + VI ( 2 ) *V2 ( 2 ) + V1I3)*V2(3) 
B = V1(1)*V1{1) + VI ( 2 ) *V1 ( 2 ) + V1(3)*V1(3) 
VII) = V1(1I*A - V2(U*B 

V ( 2 ) = VI ( 2 ) *A - V 2 ( 2 ) .* B ' ' 

V C 3 ) = VII 3 ) *A - V2 ( 3 ) *B 
RETURN 

END 
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SUBROUTINE OYAOO ( DI , 02 ,D ) 

ADDS TWO DYADS 

D = 01 ♦ 02 

IMPLICIT REAL*8(A-H,0-Z,S) 
DIMENSION Dl (3*3) , 02(3, 3), 0(3,3) 
DO 1 1=1,3 

DO 1 J = 1 » 3 

1 D( I, J) = Dl< I, J). + D2( I ,J» 

RETURN 

END 


SUBROUTINE SCLO ( A , 0 , T ) 
IMPLICIT REAL*8(A-H,0-Z,S) 
DIMENSION 0 ( 3 , 3 ) , T ( 3 , 3 ) 
MULTIPLY SCALAR BY A TENSOR 
T( 1, 1 ) = A$0 (1,1 ) 

T ( 2 , 1 ) = A*0 (2,1) 

T( 3, 1 ) = A*D( 3, 1 ) 

T ( 1 * 2 ) = 1 * 011,21 

T ( 2 , 2 ) = A*0 (2,2) 

T ( 3 , 2 ) = A*0 ( 3 » 2 ) 

T( 1,3) = A*0< 1,3) 

T ( 2 , 3 ) = A*D ( 2 » 3 ) 

T ( 3 , 3 ) = A<=0(3,3) 

RETURN 

END 


SUBROUTINE DYDOTV ( A , V , 0 ) 

SCALAR DOT PRODUCT OF DYAD AND VECTOR 
D = A . V 

IMPLICIT REAL*8( A-H,0-Z,$) 

DIMENSION D(3),A(3,3),V(3) 

DO 1 1=1,3 

D ( I ) =0 
DO 1 J= 1 , 3 

I D ( I ) = D ( I ) + A ( I , J ) * V ( J ) 

RETURN 

END ; ' • 


SUBROUTINE VXPYOV < V 1 , DY , V ) 

COMPUTES VECTOR X (DYAD . VECTOR) 
V = VI X (DY . VI ) 

IMPLICIT REAL*8(A-H,0-Z»(>) 

DIMENSION V 1 ( 3 ) * V 2 ( 3 ) *V(3)»DY(3»3) 
DO 1 K = 1 , 3 
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V2(K) = 0.00 
on l J=i ,3 . 

1 V2(K) = V2(K) + DY(K, J).*V1( J) 

V< i„)= V1(2)*V2(3> - VI ( 3 )*V2 ( 2 ) 

V ( 2 ) = Vl(3)*V2(i) - VI ( 1 ) *V2 ( 3 ) 
V (3 ) = V1(1)*V2<2) - V1(2)*V2<1) 
RETURN 
END 


SUBROUTINE DYTOV (0,X1 .X I 

USE TO TAKE SCALAR DOT. PRODUCT OF TRANSPOSE OF 
TENSOR 0 WITH VECTOR XI 

NEEDED SINCE TENSORS IN SYMMERIC MATRIX OF INERTIA TENSORS ARE IN 
NON SYMMETRIC 
IMPLICIT REAL*8< A-H.O-Z,*) 

DIMENSION 0(3«3)»X1(3)*-X(3) 

DO 1 1=1,3 

X < I ) = 0 . 

DO i J= 1 * 3 

X(I) = X(I) + D(d«I)*Xl(J) 

1 CONTINUE 
RETURN 
END 


SUBROUTINE VOOYOV ( V 1 , 0 Y , V2 , X ) 

COMPUTES THE SCALAR TRIPLE PRODUCT 

VECTOR . (OYAD . VECTOR) 
V1.IDY.V2) 

IMPLICIT REAL*8(A-H,0-Z,$) 

DIMENSION VI (3) ,DY(3,3) ,V2(3) ,TEM(3) 
DO 1 K= 1 » 3 
T.EM(K) = O.DO 
DO. 1 J = 1 » 3 

1 TEM(K) = TEM(K) + , D Y ( K , J ) *V 2 ( J ) 

X = 0 

DO 2 0=1*3 

2 X = X + V 1( J ) *TEM ( .) ) 

RETURN . 

END ■ 


SUBROUTINE DYOP ( V , D ) 

C TRANSFORMS VECTOR VI INTO SKEW DYAD 

IMPLICIT REAL*8( A-H,0-Z,S) 

DIMENSION V(3). 0(3,3) 

0 ( 1 * 1 ) = 0 

0(1,2) = V ( 3 ) 
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0(1,3) = -V ( 2 ) 
0(2, 1 ) = - V ( 3 ) 
0 ( 2 , 2 ) = 0 
0(2,3) = V ( 1 ) 
0(3,1) = V( 2) 
0(3,2) = -V ( 1 ) 
0(3,3) = 0 
RETURN 
END 


SUBROUTINE SUEOP ( VI , V2 , XM , 0 ) 

IMPLICIT REAL*8(A-H,n-Z,S) 

//.DIMENSION V1(3),V2<3), 0.(3, 3) 

C' USED TO COMPUTE THE PSUEDO INERTIA TENSOR 

C OF BODY LAMBA WITH RESPECT TO THE ORIGIN OF NEST K- 1 AND 

C THE HINGE POINT 1-1 WHICH IS ON THE TOPOLOGICAL PATH FROM 

C BODY 1 TO BODY LAMBA , . 

C RLOCK G SUPPER G AMBA , SUB K- 1 , I - 1 EQUATION 2-55 OF X-732-71-70 

C 0 = XM*< (V1.V2 >*1 - V2 VI) 

C 

C . XM - SCALAR 

C VI - VECTOR 

C V? - VECTOR 

C 1 - UNIT DYAD 

C * - SCALAR MULTIPLICATION 

C . - VECTOR SCALAR MULTIPLICATION 

C BLANK - TENSOR MULTIPLICATION 

C MOTE THAT IN GENERAL THE PSUEDO INERTIA TENSOR IS NON SYMMETRIC 

C 

0(1,1) = XM*(V1(2)*V?(2) + V1(3)*V2(3)) 

D ( 1 , 2 ) = -XM*V2< 1 )*V1 (.2 > 

0(1,3) =-XM*V?< 1 )*V1 (3) . . " . 

D ( 2 , 1 ) = — XM*V2< 2 )*V1 ( 1 ) 

0(2,2) = XM*( V2( 1 )*V1( 1 ) ■■+ -V?( 3 )*V1 ( 3 ) ) 

D ( 2 , 3 ) =-XM*V2(2)*Vl(3) 

D ( 3 , 1 ) =-XM*V2 (3)*V1 ( 1 ) 

0(3,2) =-XM*V?(3)*VI(2) 

0(3,3) = XM*(V2( 1 )*V1( 1 ) + V2 < 2 ) *V 1 ( 2 ),) 

RETURN 

END 


SUBROUTINE VECXDY(P,T,0) 

REALMS P ( 3 ) , T( 3, 3) , 0(3,3) 

C 

C COMPUTES VECTOR CROSS DYAD 

C D = P X T 

0(1,1) = P(2)*T(3,1) - P ( 3 ) * T ( 2 , 1 ). 
0(1,2) = P( 2 ) *T ( 3 , 2 ) - P ( 3 ) *T ( 2 , 2 ) 
0(1,3) = P ( 2 ) *T ( 3 , 3 ) - P ( 3 ) *T ( 2 * 3 ) 
0(2,1) = P ( 3 ) *T ( 1 , 1 ) - P(1)*T(3,1) 
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0(2.7 1 
0(2.3) 
0(3,1) 
0(3,7) 
0(3,3) 
R F TURN 
FNO 


P ( 3 ) *T ( 1.2) 
P(3)*T( 1,3) 
P( 1 )*T(7,1 ) 
P( 1 )*T( 2,7) 
P( 1 )*T( 2,3) 


P( 1 )*T<3,2) 
P( 1 ) *T.( 3 , 3 ) 
P ( 7 ) *T ( 1 ,1 ) 
P ( 7 ) *T ( 1,7) 
P ( 7 ) * T ( 1 ♦ 3 ) 
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